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/* Program Name : Drive. c _ */ 

/* Description : 4x 5.25" DSP Servo controller main kernal */ 

/* Part Number : 562096 */ 

5 /* Date : 8/12/93 */ 

/* O/S : N/A */ 

/* Compiler : TI TMS320C2x/C5x Compiler. #TMDS3242855- 02. Rel . 6.0 */ 

/* Support Packages : N/A */ 

/* Author : Dave Schell */ 

10 /* Required Files : Drive.c. Interupt. asm. C50_i nit. asm. Seek. c.Drive.h */ 

■ /* : Recal .c */ 

/* Hardware Required : Part # XXXXXX */ 

/* Install. Instr. : Link in with Drive code */ 

/* Operating Instr. : N/A */ 

15 /* */ 

/* Rev History */ 

/* Date Rev C# Init Change Description */ 

/* 4/14/94 XA 00 DLS Initial Release */ 



20 

#include "drive. h" 

main () 
{ 

25 /* Debug start */ 
int i : 

for (i=0:i<50;i++) Debug_Ram[i] - 0: 
/* Debug stop */ 

30 init_regs(); 
while(l) 
{ 

if ((Cmd_8its & CmdPending) != 0) /* Command Ready ? */ 
{ 

35 ExecuteCmdC ) ; 

} 

if ((Cmd_Bits & Tach^Bit) != 0) /* If a Rotation happened */ 
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{ 

if (TachUpLimit != 0) 
{ 

if (Tach_Time > TachUpLimit) 
5 { 

asm(" SETC INTM" ) : /* Disable intr while changing image */ 
Ctrl_Image |= DSP_Intr: /* Set DSP Int. Interupt the 188 */ 
Ctrl_Port = Ctrl_Image: /* Write to the port */ 
Stat_Buffer[0] |= SpindleError: /* Set the Spindle Error Bit */ 
10 asmC CLRC INTM"): /* Re enable interrupts */ 

} 

} 

if (TachLowLimit != 0) 
{ 

15 if (Tach_Time < TachLowLimit) 

{ 

asm(" SETC INTM"): /* Disable intr while changing image */ 
Ctrljmage |= DSP_Intr : /* Set DSP Int. Interupt the 188 */ 
Ctrl_Port = Ctrl_Image: /* Write to the port */ 
20 Stat_Buffer[0] |= SpindleError: /* Set the Spindle Error Bit */ 

asm(" CLRC INTM"): /* Re enable interrupts */ 
} 

} 

if ((Stat_Buffer[0] & FineLoop) != 0) /* If Fine Loop is closed */ 
25 { 

if ((Stat_Buffer[0] & Jumpback_0ut) != 0) /* do jumpback? */ 
{ 

Do_Jumpback(Seek_Out) : 
} 

30 if ((Stat_Buffer[0] & Jumpback_In) != 0) /* do jumpback? */ 

{ 

Do_Jumpback(Seek_In) : 
} 

} 

35 } 

if ((Ctrl_Image & LaserEnable) ~ LaserEnable) /* Regulate laser power */ 
{ 
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if ((Cmd_Bits & SenseSample) != 0) /* Fwd Sense Sample Available */ 
{ 

RegulateLaser(LS) : 
} 

5 } 
} 

} 

10 /* ExecuteCmd decodes and executes interupt recieved commands, when */ 
/* the command is completed, this routine returns and enables command */ 
/* interupts. */ 

void ExecuteCmd (void) 
15 { 

int temp; 

/* Assume the command is understood and has a good check sum */ 
Stat_Buffer[0] |= CmdComplete; /* Set Command Complete */ 
20 Stat_Buffer[0] &= -BadChkSum; /* Clear the Bad Check Sum bit */ 

Stat_Buffer[0] &= -UnknownCmd; /* Clear the Unknown Command bit */ 

if (CheckSumO ™ OxOOff) /* Test l's Complement Check Sum on Commands */ 
{ 

25 temp - (CMD_Buffer[0] » 8) & OxOOff: 

switch (temp) 

{ 

case 0 : SendStatus( ) : /* Command 0 = Status only */ 
break : 

30 case 1 : InitDriveO; /* Command 1 = Initialize drive */ 

break ; 

case 2 : LaserOnO: /* Command 2 - Initialize the laser */ 

break ; 

case 3: CaptureFocus( ) : /* Command 3 = Capture Focus */ 
35 break; 

case 4:. CaptureFine( ) ; /* Command 4 = Capture Fine Tracking */ 
break ; 
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case 5: CaptureCoarseC ) : /* Command 5 = Close the Coarse Loop */ 
break; 

case 6: ClosePinning( ) ; /* Command 6 = Close the Pinning Loop */ 
break; 

5 case 7: EnJumpbackIn( ) ; /* Command 7 = Enable Jumpback In */ 

break; 

case 8: EnJumpbackOutC ) ; /* Command 8 = Enable Jumpback Out */ 
break; 

case 9: Di sJumpback( ) ; /* Command 9 - Disable Jumpbacks */ 
10 break; 

case OxOA: MultiTrackSeek(CMD_Buffer[l] .Seek_In) ; 

break; /* Command A = Do a Seek toward spindle */ 

case OxOB; MultiTrackSeek(CMD_Buffer[l] .Seek_Out) : 

. break; /* Command B - Do Seek away from spindle */ 

15 case OxOC; OpenLoopsO: /* Command C *= Open various loops */ 

break ; 

case OxOD: ClearDSPIntrC ) ; /* Command D - Clear DSP to 188 Interrupt */ 
break; 

case OxOE; VelTabStart (); /* Command E = Read start of Vel Table */ 
20 break; 

case OxOF: ReadTimeTickC ) : /* Command F = Read 32 bit 20us Clock */ 
break ; 

case 0x10; SetTachLimitC ) ; /* Command lOh - Set Tach Pulse Limits */ 
break ; 

25 case 0x80; ReadCodeRev( ) ; /* Command 80h = Read DSP Code Rev */ 

break ; 

case 0x81; ReadMemoryC ) ; /* Command 81h = Read DSP Ram Memory */ 
break; 

case 0x82: WriteMemoryC ) : /* Command 82h = Write DSP Ram Memory */ 
30 break: 

default: BadCommandC ) : /* A bad command was sent*/ 
break; 

} 

} 

35 el se BadCheckSumC ) : 

asm(" SETC . INTM" ) ; /* disable interupts */ 

Cmd_Bits &= -CmdPending; /* Clear the Command Pending Bit */ 



} 
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Cmd Buff Point = &Stat Buffer[0]: /* Point to start of the status */ 



Cmd_Bits 


|= 0x0004; 


/* 


Set for the MSByte of the status */ 


asm(" 


CLRC 


INTM" ) ; 


/* 


enable interupts */ 


asm( M 


lamm 


I MR" ) : 


/* 


Get the Interupt Mask Register */ 


asm(" 


or 


#0100h"); 


/* 


Set enable interupt 4 bit, bit 9 */ 


asm(" 


samm 


I MR" ) : 


/* 


Enable interupt 4 */ 


asm(" 


intr 


9"); 


/* 


do an interupt 4 */ 



10 



15 



20 



25 



30 



35 



void SendStatus (void) 

{ 

} 

void InitDrive (void) 
{ 

if ((Cmd_Buff_Point 
{ 

BadCommand( ) ; 

} 

else 
{ 

Laser0n( ) ; 
ClosePinning( ) ; 
RetractO: 
CaptureFocus( ) ; 
CaptureCoarse( ) 



/* Command 0 « Status only */ 

/* Do Nothing. Set up else where, just return */ 

/* Command 1 = Init laser and servos */ 

&CMD Buffer[0]) != 2) 



/* Turn the laser on */ 

/* Close the pinning loop, enable Fine PA */ 
/* Move the carriage to inner crash stop */ 
/* Capture Focus */ 
/* Capture Coarse Tracking */ 
Stat_Buffer[0] &= -PinningLoop; /* open the Pinning loop */ 
MultiTrackSeek(3000.Seek_Out) : /* Seek out to the disk */ 
Delay(lOO); 

MultiTrackSeek(200.Seek Out); /* Seek out to the disk */ 



FocusOffsetO; 
TrackOffsetO; 



} 



} 

void LaserOn (void) 
{ 

int TimeOut:. 



/* Find Optimum Focus for RPP */ 
/* Find RPP Center value */ 



/* Command 2 = laser on and calibrate */ 
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if ((Cmd_Buff_Point - &CMD_Buffer[0]) != 2) 
{ 

BadCommandC ) ; 

} 

5 else 
{ 

Stat_Buffer[0] LoopsOpen; /* Clear Laser. Fine.Crs. Focus. Pin */ 
Read_Sense = CMO_Buffer[l] ; /* Save desired read sense value */ 
Write_Sense = CMD_Buffer[2] ; /* Save desired write sense value */ 
10 ReadMSImage =0; /* Zero all the initial values */ 

ReadMS_DAC = ReadMS Image; 

ReadLSImage = 0x4000; /* Center range. 15 bits, initial value */ 
ReadLS_DAC = (ReadLSImage « 1); /* write out the value */ 
WriteDacImage - 0; 

15 WriteJDAC = WriteDacImage; 

asmC SETC INTM" ) ; /* Disable intr while changing image */ 
Ctrl_Image &= 0x0003: /* Open loops. Laser off. leave DSP Int */ 

Ctrl_Port = Ctrl_Image: /* Write to the port */ 
asmC CLRC INTM"); /* Re enable interrupts */ 

20 Delay(lOO); /* Delay 100 * 20 us (2000 us), let laser turn off */ 

FwdSen_Zero = Int_FwdSen; /* Save the laser off value */ 
QSum_Zero = Int_QSum; /* Save the laser off value */ 

Fine_Zero = Int_Fine: /* Save the laser off value */ 

Focus_Zero = Int_Focus: /* Save the laser off value */ 

25 Crs_Zero = Int_Crs; /* Save the laser off value */ 

Stat_Buffer[0] &= -LaserError; /* Clr Laser Read Power Error */ 
Stat_Buffer[0] |= LaserEnabled; /* Laser Read Power is Not okay */ 
asm(" SETC INTM"): /* Disable intr while changing image */ 
Ctrl_Image |= LaserEnable: /* Set the laser read on bit */ 

30 Ctrl_Port = Ctrl_Image: /* Turn on the laser */ 

asm(" CLRC INTM"); /* Re enable interrupts */ 
TimeOut - 0: 

while(TimeOut < 2000) /* Regulate the laser for 40ms */ 

if ((Cmd_Bits & SenseSample) !- 0) /* Fwd Sense Sample Available */ 
35 . { 

RegulateLaser(MS) : 
Time0ut++; 
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} 

I A A A A A A A A *TeA^c*****-A^*^ / 

5 /* Capture Focus */ 

J A AA A ~k-k-k-k-k-k-k-k-k~k-k-k A AAA* ********^A^***:A^ A A A A A A** / 
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void CaptureFocus(void) 
{ 

int MaxQuadSum; 
int Counter; 
int TimeOut; 



/* Command 3 = Capture Focus and Close Loop */ 



Stat_Buffer[0] &« -FocusLoop: /* open the focus loop */ 
MaxQuadSum = QSum_Zero: /* Initialize the Quad Sum Value */ 

15 FocMS_Image =0; /* Set to zero value, signed integer */ 

Foc_MS_DAC = ZeroOffset; /* Write zero value to the DAC */ 

FocLS_Image » FocusStart: /* Set Focus Current DAC to sweep start */ 

Foc_LS_DAC = FocLS__Image + ZeroOffset; /* Write DAC with zero offset */ 
asm(" SETC INTM" ) ; /* Disable intr while changing image */ 

20 Ctrl_Image |= FocusEnable; /* Set the Focus PA Enable bit on */ 

Ctrl_Port = Ctrl_Image: /* Write out the port value */ 

asm(" CLRC INTM"): /* Re enable interrupts */ 
Delay(lSO); /* Delay 3 ms (20 * 150us) */ 

/* Find the Max Quad Sum Point */ 

25 while (FocLS_Image > FocusStop) 

{ 

Delay(5): /* Wait 100 us */ 

if (Int_QSum > MaxQuadSum) /* Get the max quad sum */ 

{ 

30 MaxQuadSum = Int_QSum: 

} 

Foc_LS_DAC = FocLS_Image + ZeroOffset; /* Write DAC with zero offset */ 
FocLS_Image -= 256; 

} 

35 /* Get the Quad Sum Threshold Level. 1/2 of Max Quad Sum */ 

MaxQuadSum « .((MaxQuadSum - QSum_Zero) » 1) + QSum_Zero: 
/* Find the Focus Point and close the loop */ 
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while ((FocLS_Image < FocusStart) & 

((Stat_Buffer[0] & FocusLoop) != FocusLoop) ) 

{ 

forCCounter = 0; Counter < 32 ; ++Counter) /* wait n times */ 

* { 

Delay(l): 

/* when quad sum okay and Focus negative */ 
if ((IntJJSum > MaxQuadSum) & ((Int_Focus - Focus_Zero) > 0)) 

{ 

Stat_Buffer[0] |= FocusLoop: /* close the focus loop */ 

} 

} 

Foc_LS_0AC = FocLS_Image + ZeroOffset: /* Write DAC with zero offset */ 
FocLS_Image 256: 

} 

if ((Stat_Buffer[0] & FocusLoop) == FocusLoop) /* If focus is closed */ 
{ 

TimeOut =0; 

whileCTimeOut < 500) /* Regulate the laser for 10ms */ 

{ 

if ((Cmd_Bits & SenseSample) != 0) /* Fwd Sense Sample Available */ 
{ 

RegulateLaser(MS) : 

if (ReadLSImage < 0x4000) /* Center range. 15 bits, initial value 
{ 

ReadLSImage = ReadLSImage + 128: /* Increment Isb of DAC */ 
ReadLSJDAC = (ReadLSImage « 1): /* write out the value */ 

} 

else 
{ 

ReadLSImage = ReadLSImage - 128: /* Decrement lsb of DAC */ 
ReadLS_DAC - (ReadLSImage « 1): /* write out the value */ 

} 

TimeOut++: 

} 

} - 

} 
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} 

/* Capture Fine Tracking */ 

J ************************************************************************ / 

5 void CaptureFine(void) /* Command 4 = Close the tracking Loop */ 

{ 

int Counter; 

while ((Counter < 2000) & ((Stat_Buffer[0] & FineLoop) != FineLoop)) 
10 { 

Delay(l); 
Counter++: 

/* when Fine Error is close to zero */ 
if (abs(Int_Fine - Fine_Zero) < 0x1000) 
15 { 

Stat_8uffer[0] |= FineLoop: /* close the fine loop around zero */ 

} 

} 

if (Counter < 2000) 
20 { 

asm(" SETC INTM" ) ; /* Disable intr while changing image */ 
Ctrl_Image |= FineEnable: /* Set the Fine PA Enable bit on */ 
Ctrl_Port ■= Ctrl_Image: /* Write out the port value */ 
asm(" CLRC INTM"); /* Re enable interrupts */ 
25 Stat_Buffer[0] |= FineLoop; /* close the fine loop */ 

} 

} 

/* Capture Coarse Tracking */ 

J ***************** ***** *********************** A* x k x k k k k A*********** k"k k k * * j 

void CaptureCoarse(void) /* Command 5 = Capture Coarse Tracking */ 
{ 

Delay(50): /* Let the fine loop settle 1 ms */ 

asm(" SETC INTM"); /* Disable intr while changing image */ 

35 Ctrl_Image |= CrsEnable: /* Set the Coarse PA Enable bit on */ 

Ctrl_Port =. Ctr]_Image; /* Write out the port value */ 

asm(" CLRC INTM"): /* Re enable interrupts */ 
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Stat_Buffer[0] |= CoarseLoop: /* close the Coarse loop */ 

} 

J a a a A A A -A AAAA A AA AAA k-kickkk-kk-kk k k A A A A A***-*-THfr*-*Hfc-***-^ * * / 

/* Close the Pinning Loop */ 

5 /*AAAAAAAAAAAAAAAAAAA kk*kk~k~k-k-k-k-kk kkk * * * * kk*kkk***kk*^*kkkkkk*kkk****k*k* j 

void ClosePinning(void) /* Command 6 «= Close the Pinning Loop */ 

{ 

asm(" SETC INTM" ) ; /* Disable intr while changing image */ 
Ctrl_Image |= FineEnable; /* Set the Fine PA Enable bit on */ 
10 Ctrl_Port = Ctrl_Image; /* Write out the port value */ 

asm(" CLRC INTM"); /* Re enable interrupts */ 
Stat_Buffer[0] |= PinningLoop; /* close the Pinning loop */ 

} 

void EnJumpbackln(void) /* Command 7 = Enable Jumpback In */ 
15 { 

Stat_Buffer[0], |= Jumpback_In; /* Enable Jumpback Toward the Spindle */ 

} 

void EnJumpbackOut (void) /* Command 8 = Enable Jumpback Out */ 
{ 

20 Stat_Buffer[0] |= Jumpback_Out ; /* Enable Jumpback Away from Spindle */ 

} 

void DisJumpback(void) /* Command 9 = Disable Jumpbacks */ 
{ 

Stat_Buffer[0] -Jumpback_In : /* Disable Jumpback Toward Spindle */ 
25 Stat_Buffer[0] &= -Jumpback_Out : /* Disable Jumpback Away from Spindle */ 

} 

/* Execute the Open Loops command from the 188 */ 

/* Execute the Open Loops command from the 188 */ 

30 / **** aaaaaaaaaaaaaaaaaaa aa * aa a aaaaa ^ / 
void OpenLoops(void) /* Command C = Open Loops */ 

{ 

asrnC* SETC INTM"): /* Disable intr while changing image */ 
if (CMD_Buffer[l] & 0x0100) /* If true disable the laser */ 
35 { 

Ctrl__Image &=.-LaserEnable; /* Clr Laser Bits of control port image */ 
Stat Buffer[0] &- -LaserError; /* Clr Laser Power Error Bit */ 



i 
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Stat_Buffer[0] &= -LaserEnabled ; /* Laser Read Power is Not okay */ 
} 

if(CMD_Buffer[l] & 0x0200) /* If true disable the focus loop */ 
{ 

Ctrl_Image &= -FocusEnable; /* Clr Focus Bit of control port image */ 
Stat_Buffer[0] &= -FocusError; /* Clr Focus Loop Error bit */ 
' Stat_Buffer[0] &= -FocusLoop: /* Open the Focus Loop */ 
} 

if(CMD_Buffer[l] & 0x0400) /* If true disable the Coarse loop */ 
{ 

Ctrl_Image &- -CrsEnable; /* Clr Coarse Bit of control port image */ 
Stat_Buffer[0] &- -CoarseLoop: /* Open the Coarse Loop */ 

} 

if(CMD_Buffer[l] & 0x0800) /* If true disable the Fine loop */ 

. { 

Ctrl_Image &= -FineEnable; /* Clr Fine Bit of control port image */ 
Stat_Buffer[0] &= -TrackingError : /* Clr Tracking Loop Error Bit */ 
Stat_Buffer[0] &= -FineLoop; /* Open the Fine Loop */. 

} 

if (CMD_Buffer[l] & 0x1000) /* If true disable the Pinning loop */ 
{ 

Ctrl_Image &= -FineEnable; /* Clr Fine Bit of control port image */ 
Stat_Buffer[0] &= -PinningLoop; /* Open the Fine Loop */ 

} 

if(CMD_Buffer[l] & 0x2000) /* If true clear the spindle error bit */ 
{ 

5tat_Buffer[0] &= -SpindleError ; /* Clear the spindle error bit */ 
} 

Ctrl_Port = Ctrl__Image; /* Clear the actual bits */ 

asm(" CLRC INTM" ) ; /* Re enable interrupts */ 

/* Execute the Clear DSP Interrupt command from the 188 */ 
d ClearDSPIntr(void) /* Command D = Clear DSP to 188 Interrupt 

asm(" SETC INTM"); /* Disable interrupts while changing image */ 
Ctrl_Image &= -DSP__Intr; /* Clear the LSBit of the control port image */ 
Ctrl Port - Ctrl_Image; /* Clear the actual bit */ 
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asm(" CLRC INTM" ) ; /* Re enable interrupts */ 

} 

/* Execute the Velocity Table Start Address */ 
void VelTabStart(void) /* Command OEh = Read Velocity Table Start Address * 

{ 

Stat_Buffer[l] = ((int) &Vel_Table); /* Store Vel Table Start Addr */ 
Stat_Buffer[2] = ((int) SlnverseTime) ; /* Store Inverse Time Start Addr * 

} 

/* Execute the Read Time Tick Counter */ 
void ReadTimeTickO /* Command OFh = Read Time Tick Counter */ 

{ ■ 

asm(" SETC INTM"): /* Disable intr while storing the values */ 
Stat_Buffer[l] = Count_20_MSW ; /* Store Time Tick MSWord */ 
Stat_Buffer[2] - Count_20_LSW: /* Store Time Tick LSWord */ 
asm(" . CLRC INTM"); /* Re enable interrupts */ 

} 

/* Execute the Set Tach time limits */ 
void SetTachLimit(void) /* Command lOh = Set the tach pulse limits */ 

{ 

TachUpLimit « CMD_Buffer[l] : /* Save the upper limit value */ 
TachLowLimit = CMD_Buffer[2] ; /* Save the lower limit value */ 

} 

/* Execute the Code Revision Read command from the 188 */ 
void ReadCodeRev(void) /* Command 80h = Read the DSP Code Rev Level */ 

{ 

static char Rev[5]-{ Revision }; /* Rev level reported by ReadCodeRev */ 

Stat_Buffer[l] = ((int) Rev[0] « 8): /* Get the Character. SHL 8 */ 
Stat_Buffer[l] |= (int) Rev[l]: /* Get 2nd Character in buffer */ 
Stat_Buffer[2] - ((int) Rev[2] « 8); /* Get the 3rd Character. SHL 8 */ 
Stat_Buffer[2] |= (int) Rev[3]: /* Get 4th Character in buffer */ 

} 

/* Execute the Memory read command from the 188 */ 
void ReadMemory(void) /* Command 81h « Read DSP Ram Memory */ 

{ 

i n t *Temp_PL . *Temp_P2 . Temp ; 
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10 



15 



Temp_Pl - &CMD_Buffer[0]: 
++Temp_Pl; 

Temp_P2 = (int *) *Temp_Pl: 
Temp_Pl = &Stat_Buffer[0]: 
++Temp_Pl ; 

while (TempJ>l < &CMD_Buffer[0]) 
{' 

*Temp_Pl = *Temp_P2; 
++Temp_Pl: 
++Temp_P2 : 

} 



/* Point to 1st Cmd Byte */ 
/* Point to Address Value */ 
/* Load Address into Temp_P2 */ 
/* Point to the Status Buffer */ 
/* Point to the 1st data word */ 
/* Move all the words */ 

/* Store a word of data */ 

/* Point to next data word */ 

/* Point to next storage location */ 



} 

/* Execute the Memory write command from the 188 */ 
void WriteMemory(void) /* Command 81h = Write DSP Ram Memory */ 

{ 

i nt *Temp_Pl . *Temp_P2 . Temp ; 



20 



25 



30 



35 



Temp_Pl - &CMD_Buffer[0]: 
++Temp_Pl ; 

Temp_P2 = (int *) *Temp_Pl; 
++Temp_Pl ; 

while (Temp_Pl <= Cmd_Buff_Point ) 
{ 

*Temp_P2 = *Temp_Pl: 
++Temp_Pl: 
++Temp_P2 ; 

} 



/* Point to 1st Cmd Byte */ 
/* Point to Address Value */ 
/* Load Address into Temp_P2 */ 
/* Point to 1st data word */• 
/* Move all the words */ 

/* Store a word of data */ 

/* Point to next data word */ 

/* Point to next storage location */ 



} 

/* Set up the status buffer saying the command was not understood */ 
void BadCommand(void) /^Command ? = an undefined command */ 

{ 

Stat_Buffer[0] &= -CmdComplete; /* Clear Command Complete */ 
Stat_Buffer[0] |= UnknownCmd: /* Set Unknown Command bit */ 

} 

/* Set up the status buffer saying the checksum was bad */ 
void BadCheckSum(void) 
{ 
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Stat_Buffer[0] &= -CmdComplete: /* Clear Command Complete */ 
Stat_Buffer[0] |= BadChkSum; /* Set Bad Check Sum bit */ 

} 

5 /* Calculate the checksum on the command buffer */ 

int CheckSum(void) 

{ 

int *Temp_Point .sum; 

10 sum « 0; /* Initialize the Sum Value */ 

Temp_Point - &CMD__Buffer[0] : /* Point to 1st Cmd Byte */ 

while (Temp_Point <» Cmd_Buff_Point) /* Do Summation for all bytes */ 

{ 

sum += *Temp_Point + (*Temp_Point » 8); /* Sum both bytes of word */ 
15 ++Temp_Point ; /* Point to next command word */ 

} 

sum &- OxOOFF; /* Clear MSByte */ 

return(sum); /* Return with Sum Value */ 

} 

/* Delay so many 20us time ticks then return */ 

void Delay(int ticks) 
{ 

25 int Stop_Time: 

Stop_Time = Count_20_LSW + ticks: /* Calculate the stop time */ 

while (Stop_Time != Count_20_LSW) /* Repeat until counter equals stop */ 

{ 

30 } 
} 

J ■*Hfk~k-k-k-k*-k-k-k-k'k* AAA AAAA AAAA A A AAAAAAAAA- * ^★yT^^^y ^^^^^^^^^★★^★^★★^^^^★^-Ar^ / 

/* Regulate the laser read power */ 

/ AA A A AA A AAA :AAAAAAAAAAA A "A- A AAAAAAAAAAAA k*-k-^*******±-k-k-k'k-k ** * ***A AA AAAAA AAAAAAA / 

35 void Regulatel_aser(int MSJ_S) 

{ /* Integrate around Read_Sense. Desired - Unsign ADC Value */ 
int ReadPCLError; 
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/* Int_FwdSen is a 10 bit unsigned (positive) number */ 
ReadPCLError = ((Int_FwdSen - FwdSen_Zero) - Read_Sense): 
if (MS_LS == LS) 
{ 

ReadLSImage = (ReadLSImage - ReadPCLError): 
if (ReadLSImage < 0) /* Over or Under Flow */ 
{ 

if (ReadPCLError > 0) /* UNDER FLOW */ 
{ 

ReadLSImage = 0: 
} 

el se 
{ 

ReadLSImage = 0x7FFF: 
} - 

RegulateLaser(MS) : /* Regulate with the Large bit step 
} 

ReadLS_DAC = (ReadLSImage « 1): 
} 

el se 
{ 

ReadliSImage = (ReadMSImage - ReadPCLError): 
if (ReadMSImage < 0) 
{ 

if (ReadPCLError > 0)- /* UNDER FLOW */ 
{ 

ReadMSImage = 0: 
} 

else 
{ 

ReadMSImage = 0x7FFF: 
} 

} 

ReadMS_DAC = (ReadMSImage « 1): 
} 

if (abs(ReadPCLF_ r ro r ) < ReadPowerTol ) 
{ 



10 



15 



20 



25 



30 
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Stat_Buffer[0] &= -LaserError : /* Laser Read Power is Okay */ 
} 

else 
{ 

Stat_Buffer[0] |= LaserError; /* Laser Read Power is Not okay */ 
} 

asm(" SETC INTM" ) ; /* Disable interupts */ 

Cmd_Bits &= -SenseSample: /* Clear the Sense Available Bit */ 

asm(" CLRC INTM"); /* enable interupts */ 



V A" "A" -k A A" "A" -A A A. A "A A" A A" A A k "A A" "A" A k A A j 



/* 
/* 
/* 
/* 
/* 
/* 
/* 
I* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 



Program Name 

Description 

Part Number 

Date 

0/S 

Compi ler 
Support Packages 
Author 

Required Fi les 

Hardware Required 
Install. Instr. 
Operating Instr. 



Drive. h 

4x 5.25" DSP Servo controller header file 

562095 

8/12/93 

N/A 

TI THS320C2x/C5x Compi ler .#TMDS3242855-02 .Rel . 
N/A 

Dave Schell 

Dri ve . c . I nterupt . a sm . C50_i ni t . a sm . Seek . c . Dr i ve 

Recal .c 

Part # XXXXXX 

Link in with Drive code 

N/A 



Rev History 
Date Rev 



C# Init Change Description 



4/14/94 



XA 00 DLS Initial Release 



*/ 
*/ 
*/ 
*/ 
*/ 
.0 */ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 
*/ 



enum Seek_Dir {SeekJDut .Seek^In} ; /* direction const Jumpback and seek */ 
enum Laser_Reg {LS .MS} ; /* LS.MS Test for laser regulation */ 



35 #define Revision "XA00" 



/* The current Revision Level */ 



#define Retr Accel 6345 



/* (2.0 Gs / 0.0003152 Gs/bit) */ 



#define Retr Pulses 100 



#define Foc_Step 655 
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/* Number of Retract Pulses */ 

/* Focus Step Size for Auto Focus */ 
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#define JB_Accel 9835 
#define JBJteceV -13959 
#define Seek_Accel 18718 
#define Seek_Decel -13959 
#define Hi_BW_Tracks 10 
#define HiSeekGain 149 
#define LowSeekGain 99 



/* (3.1 Gs / 0.0003152 Gs/bit) ■*/ 

/* (4.4 Gs / 0.0003152 Gs/bit) */ 

/* (5.9 Gs / 0.0003152 Gs/bit) */ 

/* (4.4 Gs / 0.0003152 Gs/bit) */ 

/* Seek length for using high Bandwidth */ 

/* 149. Wide BW (750 Hz) Gain constant */ 

/* 99. Low BW (500 Hz) Gain constant */ 





#define 


CmdComplete 0x8000 


/* 


Status 


Word Command Complete Bit */ 


15 


#def i ne 


BadChkSum 0x4000 


/* 


Status 


Word Bad Check Sum Bit */ 




#define 


UnknownCmd 0x2000 


/* 


Status 


Word Unknown Command Bit */ 




#def i ne 


TrackingError 0x1000 


/* 


Status 


Word Tracking Error Bit */ 




#define 


SpareBit 0x0800 


/* 


Status 


Word Spare Bit */ 




#define 


FocusError 0x0400 


/* 


Status 


Word Focus Error Bit */ 


20 


#def i ne 


LaserError 0x0200 


/* 


Status 


Word Laser Control Error Bit */ 




#define 


FocusLoop 0x0100 


/* 


Status 


Word Focus Loop Closed Bit */ 




#define 


FineLoop 0x0080 


/* 


Status 


Word Fine Loop Closed Bit */ 




#def me 


CoarseLoop 0x0040 


/* 


Status 


Word Coarse Loop Closed Bit */ 




#define 


PinningLoop 0x0020 


/* 


Status 


Word Pinning Loop Closed Bit */ 


25 


#define 


SpindleError 0x0010 


/* 


Status 


Word Tach Out of Spec Bit */ 




#def i ne 


LaserEnabled 0x0008 


/* 


Status 


Word Laser Read Power is on */ 




#define 


Jumpback_In 0x0004 


/* 


Status 


Word Jumping Back In Bit */ 




#define 


JumpbackJDut 0x0002 


/* 


Status 


Word Jumping Back Out Bit */ 




#def i ne 


Bad_Seek 0x0001 


/* 


Status 


Word Bad Seek/no Vel Table Bit */ 


30 


#def i ne 


LoopsOpen OxEOOF 


/* 


Clear Tach. Focus. Coarse. Fine. Pin */. 



35 



#define SenseSample 0x0080 
#define CmdPending 0x0001 
#define Tach_Bit 0x0200- 

#define ReadPower To] . 0x0005 
#define FocusEnable 0x0080 



/* Sense Sample Available Bit */ 

/* Command Bits. Command pending Bit */ 

/* Command Bits. Motor Tach Bit */ 

/* Read Power Okay Tolerance */ 

/* Control Port Focus PA Enable Bit */ 
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#define FineEnable 


0x0040 


/* 


Control 


Port 


Fins PA Enable Bit */ 


#define CrsEnable 


0x0020 


/* 


Control 


Port 


Fine PA Enable Bit */ 


#define DTCS_Clk_Pol 


0x0010 


/* 


Track Crossing Clock Polarity */ 


#define LaserEnable 


0x0008 


/* 


Control 


Port 


Laser Enable Bit */ 


#define Software_TP 


0x0002 


/* 


Control 


Port 


Software Test Point Bit */ 


#define DSP_Intr 


0x0001 


/* 


Control 


Port 


DSP to 188 interrupt Bit */ 





#define 


FocusStart 32000 




/* Focus Capture Sweep Current Minimum */ 




#define 


FocusStop -32000 




/* Focus Capture Sweep Current Maximum */ 


10 


#define 


ZeroOffset 0x8000 




/* Zero Offset value for the DACs */ 




#define MaxPositive 0x7FFF 




/* Max positive signed integer value */ 




#define MaxNegative 0x8000 




/* Max negative signed integer value */ 




extern 


int 


Read_Sense: 


/* 


Laser Read Sense Desired Level */ 


15 


extern 


int 


Write_Sense: 


/* 


Laser Write Sense Desired Level */ 




extern 


int 


ReadMSImage: 


/* 


Laser Read DAC Bit Image */ 




extern 


int 


ReadLSImage: 


/* 


Laser Read DAC Bit Image */ 




extern 


int 


WriteDacImage; 


/* 


Laser Write DAC 16 Bit. Image */ 




extern 


int 


MaxRPP; 


/* 


Maximum RPP Value seen during a jumpback */ 


20 


extern 


i nt 


MinRPP: 


/* 


Minimum RPP Value seen during a jumpback */ 




extern 


int 


FwdSen_Zero: 


/* 


ADC Forward Sense Value with the laser off */ 




extern 


int 


QSum_Zero ; 


/* 


ADC Quad Sum Value with the laser off */ 


25 


extern 


int 


Fine_Zero; 


/* 


ADC Tracking Value with the laser off */ 




extern 


int 


Focus_Zero; 


/* 


ADC Focus Value with the laser off */ 




extern 


int 


Crs_Zero; 


/* 


ADC Coarse Error Zero */ 




extern 


int 


FineDacZero; 


/* 


Fine DAC Zero or Seek Accel Value */ 




extern 


int 


CrsDacZero; 


/* 


Crs DAC Zero or Seek Accel Value */ 


30 


extern 


int 


FocLS_Image; 


/* 


Focus Current LS (Capture) DAC 16 Bit Image */ 




extern 


int 


FocMS_Image; 


/* 


Focus Current MS (Servo) DAC 16 Bit Image */ 




extern 


int 


FineDacImage: 


/* 


Fine Current (Servo) DAC 16 Bit Image */ 




extern 


int 


Cmd_Bits; 


/* 


Command ready Status Flag */ 




extern 


int 


*Cmd_Buff_Point: 


/* 


Command Buffer Pointer */ 


35 


extern 


int 


Stat_Buffer[5]: 


/* 


The first word of the status buffer */ 




extern 


int 


CMD_Buffer[10]: 


/* 


The first word of the command buffer */ 




extern 


int 


SPC; 


/* 


The Serial Control Input Port */ 
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10 



15 



20 



25 



30 



extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 
extern 



int Track_Cnt; 
nt Ctrl_Port: 
nt Ctrl_Image; 
nt Foc_LS_DAC: 
nt Foc_MS_DAC: 
nt Foc_Err_Cnt; 
nt Focus_Limit ; 
nt Fine_DAC: 
nt Fine_Err_Cnt : 
nt Fine_Limit: 
nt Crs_DAC; 
nt Write_DAC; 
nt ReadLS_DAC : 
nt ReadMS_DAC: 
nt Spare_DAC: 
nt Int_Focus; 
nt Int_Fine; 
nt Int_Crs: 
nt Int_FwdSen; 
nt Int_QSum: 
nt Int_Test: 
nt Count_20_MSW; 
nt Count_20_LSW; 
nt TachUpLimit: 
nt TachLowLimit : 
nt Tach_Time; 
nt Vel_Table[384]; 
nt InverseTime[25] 
nt Debug_Ram[50] : 
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void initjregs(void) ; 
void ExecuteCmd(void) : 
void SendStatus(void) ; 
void InitDri ve(void) : 
void LaserOn(void) : 
void CaptureFocus(vqid) ; 
void CaptureFine(void) : 



/* The Track Crossing Counter Input Port */ 

/* The Output Control Port */ 

/* The memory image of the Control Port */ 

/* Focus DAC Memory Location */ 

/* Focus DAC Memory Location */ 

/* Focus Out of limit sample counter */ 

/* Focus Error Spec Limit Value */ 

/* Fine DAC Memory Location */ 

/* Focus Out of limit sample counter */ 

/* Focus Error Spec Limit Value */ 

/* Coarse DAC Memory Location */ 

/* Write DAC Memory Location */ 

/* Read DAC Memory Location */ 

/* Read DAC Memory Location */ 

/* Spindle or Test DAC Memory Location */ 

/* Focus Interupt Value */ 

/* Fine Interupt Value */ 

/* Coarse Interupt Value */ 

/* Forward Sense Interupt Value */ 

/* Quad Sum Interupt Value */ 

/* Test Interupt Value */ 

/* 20us Time tick counter, upper 16 bit value */ 
20us Time tick counter, lower 16 bit value */ 
/* Tach Pulse upper time limit */ 
/* Tach Pulse lower time limit */ 
/* Tach Pulse Recurrence Interval time */ 
/* Seek Velocity Table Starting Address */ 
/* Inverse Time Table for seek velocity calcs */ 
/* Inverse Time Table for seek velocity calcs */ 

/* Initialize the DSP registars */ 
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void CaptureCoarse(void) : 

void ClosePinning(void) ; 

void EnJumpbackln(void) : 

void EnJumpbackOut(void) ; 
5 void DisJumpback(void) ; 

void OpenLoops(void) ; 

void ClearDSPIntr(void) : 

void VelTabStart(void) ; 

voi d ReadTi meTi ck ( voi d ) ; 
10 void SetTachLimit(void) ; 

void ReadCodeRev(void) ; 

void ReadMemory(void) : 

void WriteMemory(void) : 

void BadCommand(void) : 
15 void BadCheckSum(void) : 

int CheckSum(void) : 

void DelayCint ticks) ; 

void RegulateLaser(int) ; 

void Do_Jumpback(int) ; 



void Track_Capture(int. int): 




void 


MultiTrackSeek(int. 


int) : 




void Retract(void) : 


/* Move the carriage to inner crash stop */ 




void 


FocusOffset(void) : 


/* Find the Zero Offsets for Max RPP */ 




void TrackOffset(void) : 


/* Find Zero Offset at (Max Rpp + Min RPP)/2 */ 




int 


FindPeaktoPeak(void) 


: /* Find the peak to peak RPP Value */ 




/*** 


****AAAA A************ ***>*UU A*-*-*** *. A A A A A*** * A A A -A*** A A A A A A A A -A-*-*-**** * * * **/ 


/* 


Program Name 


Seek . c 


*/ 


/* 


Description 


4x 5.25" DSP Servo controller seek routines 


*/ 


/* 


Part Number 


562096 


*/ 


/* 


Date 


12/12/93 


*/ 


/* 


0/S 


N/A 


*/ 


/* 


Compi 1 er 


TI TMS320C2x/C5x Compi ler. #TMDS3242855-02. Rel . 6.0 


*/ 


/* 


Support Packages 


N/A 


*/ 


/* 


Author 


Dave Schell 


*/ 


/* 


Required Files 


Dri ve . c . I nterupt . asm . C50_i ni t . asm . Seek . c . Dri ve . h 


*/ 


/* 




: Recal .c 


*/ 


/* 


Hardware Required 


: Part # XXXXXX 


*/ 



/* 
/* 
/* 
/* 
/* 
/* 



Install. Instr. 
Operating Instr. 
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Link in with Drive code 
N/A 



Rev History 

Date Rev C# I nit 
04/14/94 XA 00 DLS 



Change Description 
Initial Release 



*/ 
*/ 
*/ 
*/ 
*/ 
*/ 



10 



15 



20 



25 



30 
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#include "drive. h" 
/* Multi Track Seek in or out 



■*/ 

******************* j 



I 

void MultiTrackSeek(Tracks . InJDut) 

int Tracks . InJDut: 

{ 

i nt Accel . Decel . Si gn . i . Del t aTi me . 01 dTi me . NewTi me : 

int MeasuredVel .DesiredVel .TrackCount .Oldjrkjnt .New_Trk_Cnt.DeltaTracks; 
i nt LoopError . LoopGa i n . Vel Error . MaxVel Error . 01 dCrsDacZero ; 
int OldHalfTrack.HalfTrack: 

TrackCount = Tracks: /* Get the number of track to seek */ 

/* Setup the direction dependent parameters */ 
if (ln_0ut ™ Seek_In) 
{ 

Sign = 1: 

asrnC SETC INTM" ) ; /* Disable intr while changing image */ 
/* debug */ 

Ctrl_Port - Ctrl_Image |= Software_TP; /* Write to the port */ 
Ctrl_Port - Ctrljmage &= -Software_TP: /* Write to the port */ 
/* debug */ 

Ctrljmage |= DTCS_Clk_Pol : /* Set the DTCS Clock Polarity Bit */ 
Ctrl__Port = Ctrljmage: /* Write to the port */ 
asm(" CLRC INTM" ) : /* Re enable interrupts */ 

} 

else . 
{ 
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Sign = -1: 

asm(" SETC INTM" ) ; /* Disable intr while changing image */ 
/* debug */ 

Ctrl_Port = Ctrl_Image |- Software_TP: /* Write to the port */ 
Ctrl_Port = Ctrl_Image &= ~Software_TP: /* Write to the port */ 
/* debug */ 

Ctrljmage &= ~DTCS_C1 k_Pol ; /* Clear the DTCS Clock Polarity Bit */ 
Ctrl_Port = Ctrl_Image: /* Write to the port */ 

asm(" CLRC INTM"): /* Re enable interrupts */ 

} 

Decel » Seek_Decel * Sign: 

/* If velocity table initilaized and focus is closed */ 
if ((Vel_Table[0] != -1) && (Stat_Buffer[0] & FocusLoop) && (TrackCount > 

&& (InverseTime[0] != -1) ) 
{ /* then do the seek */ 

Stat_Buffer[0] &= -Bad_Seek: /* Clear the bad seek status bit * 

if (TrackCount < 5) 
{ 

for (i - 0; i < TrackCount: i++) Do_Jumpback( In_0ut ) : 

} 

else 
{ 

if (TrackCount > Hi_BW_Tracks) 
{ 

Accel = MaxPositive * Sign: 

LoopGain - HiSeekGain * Sign: /* Set the Seek Gain for High BW * 

} 

else 
{ 

Accel = Seek_Accel * Sign; 

LoopGain = LowSeekGain * Sign: /* Set the Seek Gain for low BW */ 

} 

MaxVel Error = abs(MaxPositi ve / LoopGain): 
OldTime = Count_20_LSW : /* Get the start time */ 
MeasuredVel =0; /* Starting Velocity = 0 */ 
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Stat_Buffer[0] &« -FineLoop; /* open the fine loop */ 

FineDacImage = Accel ; /* Update the Image Value */ 

Fine_DAC = (Accel + ZeroOffset): /* write out the acceleration value */ 

OldCrsDacZero = CrsDacZero; 

CrsDacZero = Accel; /* Output the coarse loop accel value */ 

Delay(5): /* Wait 100 us for RPP to go away from zero */ 

New_Trk_Cnt = (Track_Cnt. & OxOOFF); /* Get the track counter value */ 
01d_Trk_Cnt = New_Trk_Cnt; /* Set them equal before starting loop */ 
if ((01d_Trk_Cnt & 0x0080) — 0) HalfTrack - 1; else HalfTrack - 0: 
OldHalfTrack «= HalfTrack; /* Set them equal before starting loop */ 
while (TrackCount > 1) 
{ 

if (MeasuredVel < MaxPositive ) /* Velocity > 80.0 mm/s */ 
{ 

i = 0; 

while ((i < 6000) & (New_Trk_Cnt==01d_Trk_Cnt) ) 
{ 

i++: 

New_Trk_Cnt = (Track_Cnt & OxOOFF); /* Get track count value */ 

} 

} 

el se 
{ 

Delay(l); /* at high velocity delay 1 time tick */ 

} 

New_Trk_Cnt - (Track_Cnt & OxOOFF): /* Get track count value */ 
NewTime = Count_20_LSW; /* Get the current time */ 

if ((New_Trk_Cnt & 0x0080) == 0) HalfTrack = 1: else HalfTrack = 0: 
DeltaTracks = (New_Trk_Cnt - 01dJTrk_Cnt) & 0x007F: /* Get Delta */ 
01d_Trk_Cnt - NewJTrk_Cnt; /* Save the Track Count Value */ 
TrackCount -= DeltaTracks; /* Update the track counter */ 

/* Calculate the number of half tracks */ 
DeltaTracks = (DeltaTracks * 2) + HalfTrack - OldHalfTrack: 
OldHalfTrack =• HalfTrack; 
DeltaTime = (NewTime - OldTime) - 1; 

OldTime - NewTime: /* Save the time for next time */ 

if (DeltaTime > 24) DeltaTime = 24; 
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MeasuredVel = DeltaTracks * InverseTime[DeltaTime] : 

if (TrackCount > 9280) /* Tracks > 128+(8*128)+( 64*128) */ 

DesiredVel « Vel_Table[333] ; 
else if (TrackCount > 1152) 

DesiredVel = Vel_Table[256 + ((TrackCount - 1152) » 6)]: 
else if (TrackCount > 128) 

DesiredVel = Vel_Table[128 + ((TrackCount - 128) » 3)]: 
else 

DesiredVel = Vel_Table[TrackCount] : 

/* Loop Error - LoopGain * (Desired Velocity - Measured Velocity) 
Vel Error = (DesiredVel - MeasuredVel): 
if (abs(VelError) < MaxVelError) 

LoopError = LoopGain * Vel Error: 

else 

if (Vel Error > 0) 
{ 

LoopError = (MaxPositive * Sign); 

} 

else 
{ 

LoopError = - (MaxPositive * Sign): 

} 

} 

FineDacImage = LoopError: /* Update the Image Value */ 
Fine_DAC =. (LoopError+ZeroOffset) ; /* write out accel value */ 
CrsDacZero = LoopError: /* Output the coarse loop accel value */ 
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10 



15 



} 

CrsDacZero = OldCrsDacZero: 
Track_Capture(In_Out. Decel ) ; 

} 

} 

else 
{ 

Stat_Buffer[0] |= Bad_Seek: 

} 



/* If Vel Table Not initialized */ 



/* Set bad seek status bit */ 



} 



/* Do a Jumpback in or out */ 

void Do_Jumpback(In_Out) 

int In_0ut: 

{ 

int Accel .Decel . i ; 



20 



25 
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MaxRPP - 0: 
MinRPP = 0: 

asm(" SETC INTM" ) 
Cmd_Bits &= -Tach_Bit: 
asm(" CLRC INTM" ) 
if (In_0ut — Seek_In) 
{ 

JB_Accel ; 
JB Decel ; 



/* Initialize the min and max values to 0 */ 
/* Disable interupts */ 
/* Clear the Tach Bit */ 
/* enable interupts */ 
/* do jumpback in */ 



/* do jumpback out */ 



Accel 
Decel 
} 

else 
{ 

Accel = -JB_Accel ; 
Decel - -JB_Decel : 
} 

Stat_Buffer[0] & — FineLoop; /* open the fine loop */ 

FineDacImage - Accel; /* Update the Image Value */ 

Fine_DAC = (Accel + ZeroOffset); /* write out the acceleration value */ 

for (i - 0: i < 6; i++) /* Wait 120 us for RPP to go away from zero */ 
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{ 

Delay(l): 

if (MaxRPP < Int_Fine) MaxRPP = Int_Fine: /* Find RPP Min and Max */ 
if (MinRPP > Int_Fine) MinRPP = Int_Fine: 

5 } 

Track_Capture(In_Out. Decel ) ; 

} 

/ *********** AAA A****************************^ 

/* Track Capture After Jumpback or a seek */ 
10 / / 
void Track_Capture ( InJDut. Decel ) 
int In_0ut .Decel ; 
{ 

int Counter . i ; 
15 int OldOacZero: 

/* Get ready for Capture */ 
OldDacZero = FineDacZero: 
FineDacZero = Decel ; 
20 Counter «= 0; 

/* Wait for 1/2 track */ 
if (InJDut == Seek_In) /* Wait for RPP to go low */ 
{ 

while (((Int_Fine - Fine_Zero) < 0) & (Counter < 6000)) 
25 { 

Counter**; 

if (MinRPP > Int_Fine) MinRPP - Int_Fine: /* Find RPP Min */ 
} 

} 

30 else /* wait for RPP to go high */ 

{ 

while (((Int_Fine - Fine_Zero) > 0) & (Counter < 6000)) 
{ 

Counter++; 

35 if (MaxRPP < Int_Fine) MaxRPP = Int_Fine; /* Find RPP Max */ 

} 

} 
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FineDacImage = Decel : /* Update the Image Value */ 

Fine_DAC = (Decel + ZeroOffset): /* Write out the deceleration value */ 

for (i = 0; i < 3: i++) /* Wait 60 us */ 

{ 

5 Delay(l): 

if (MaxRPP < Int_Fine) MaxRPP = Int_Fine; /* Find RPP Min and Max */ 

if (MinRPP > Int_Fine) MinRPP « Int_Fine; 

} 

Stat_Buffer[0] |= FineLoop; /* Close the fine tracking loop */ 
10 for (i = 0; i < 3; i++) /* Wait 80 us */ 

{ 

Delay(l): 

if (MaxRPP < Int_Fine) MaxRPP = Int_Fine: /* Find RPP Min and Max */ 

if (MinRPP > Int_Fine) MinRPP = Int_Fine; 

15 } . 

FineDacZero = OldDacZero; /* Remove the deceleration pulse */ 

} 

/* Retract the Carriage to the inner Crash Stop */ 

void Retract (void) 
{ 

int i ; 

25 asm( M SETC INTM" ) ; /* Disable intr while changing image */ 

Ctrl_Image |= CrsEnable: /* Set the Coarse PA Enable bit on */ 
Ctrl_Port = Ctrl_Image; /* Write out the port value */ 
asmC CLRC INTM"); /* Re enable interrupts */ 
for (i = 0: i < Retr_Pulses; i++) 

30 { 

Crs^DAC = Retr_Accel + ZeroOffset: /* Accel toward the spindle */ 
Del ay (250); /* for 5 ms */ 

Crs_DAC = ZeroOffset: /* Coast toward the spindle */ 
Delay(750): /* for 15 ms */ 

35 } 

CrsJ)AC = Retr_Accel + ZeroOffset: /* Hold at inner crash stop */ 
Delay(5000); /* for 100 ms */ 
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} 



/* Program Name : Recal.c */ 

/* Description : 4x 5.25" DSP Servo controller recal ibration stuff */ 

5 /* Part Number : 552096 */ 

/* Date : 2/2/94 */ 

/* 0/S : N/A */ 

/* Compiler : TI TMS320C2x/C5x Compiler t #TMDS3242855-02.Rel . 6.0 */ 

/* Support Packages : N/A */ 

10 /* Author : Dave Schell */ 

/* Required Files : Dri ve.c . Interupt . asm. C50_i nit. asm. Seek. c.Drive.h */ 

/* : Recal.c */ 

/* Hardware Required : Part # XXXXXX */ 

/* Install. Instr. : Link in with Drive code */ 

15 /* Operating Instr. : N/A */ 

/* */ 

/* Rev History */ 

/* Date Rev C# Init Change Description */ 

/* 4/14/94 XA 00 DLS Initial Release . */ 

20 

#inc!ude "drive. h" 

25 /* Set focus zero to the optimum RPP Focus Offset */ 



/ AAAAA * *A ******** AAAAAAAA**AAAAAAAAA AAAAAAAA K ^-^^^^^^^^^^^^^^^^^-^^^^-tc^t****** j 

void FocusOffset(void) /* Find the Zero Offsets for Max RPP */ 
{ 

int j .PeaktoPeak[3] .Center ; 

30 

for (j = 0; j < 3; PeaktoPeak[ j] = 0; 

Center = Focus_Zero; 
for (j = 0; j < 3': j++) 
{ ' 

35 Focus_Zero = Center - Foc_Step + (j * Foc_Step): 

PeaktoPeakC j] = FindPeaktoPeakC ) ; 

} 
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if (PeaktoPeakCO] > PeaktoPeakC2]) 
{ 

while ((j < 20) & (PeaktoPeakCO] > PeaktoPeak[2] ) ) 
{ 

Center -= Foc_Step: 
Focus_Zero = Center - Foc_Step: 
PeaktoPeak[2] = PeaktoPeak[l] : 
PeaktoPeakCl] = PeaktoPeakCO]; 
PeaktoPeakCO] = FindPeaktoPeak( ) : 

} 

} 

else 
{ 

while ((j < 20) & (PeaktoPeakC2] > PeaktoPeakCO])) 
{ 

Center += Foc_Step: 
Focus_Zero = Center + Foc_Step: 
PeaktoPeakCO] = PeaktoPeakCl] : 
PeaktoPeakCl] = PeaktoPeakC2] : 
PeaktoPea!<C2] = FindPeaktoPeak( ) : 

} 

} 

Focus_Zero = Center: 

} 

/* Set RPP Zero to the center of the peak to peak RPP */ 

j A^t^fc^fc^ifcTA^fcwnfc^r'A" it ^r^"^f ^nfc'Tfc A A A A A A"A' "A" a"X""a"A 1 "a 1 ~k 'A 1 'A A 1 A A A A A A A A A A A'TA.'^Tt^nArTfr^nt ^fc~k~fc m fc m fc''jc'Tk'&'& ^ A' "A 1 it Ar^ 1 "A" A 1 AfA" j 

void TrackOffset(v.oid) /* Find Zero Offset at (Max Rpp + Min RPP)/2 */ 
{ 

int i .Max.Min; 

Max = Min - 0: /* Initialize the value */ 

for (i - 0: i < 8; i++) 
{ 

Delay(50):.. 
Do_Jumpback(Seek_In) ; 



r 



10 
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Max += MaxRPP » 4; /* Max Value / 16 */ 
Min += MinRPP » 4; /* Min Value / 16 */ 

} 

for (i = 0; i < 8; i++) 
{ 

Delay(50); 

Do_Jumpback(Seek_Out) ; 

Max MaxRPP » 4: /* Max Value / 16 */ 

Min += MinRPP » 4: /* Min Value / 16 */ 

} 

Fine Zero - (Max + Min) » 1; /* (Max RPP + Min RPP) / 2 */ 
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/* Measure the peak to peak RPP value by doing jumpbacks in and out 



int FindPeaktoPeak(void) /* Find the peak to peak RPP Value */ 



{ 



int i .PeaktoPeak ; 



20 



PeaktoPeak = 0: 



/* Initialize the value */ 



25 



/* Clear the Tach Bit */ 
asm(" SETC INTM" ) ; /* Disable interupts */ 
Cmd_Bits &= -Tach_Bit: /* Clear the Tach Bit */ 

asm(" CLRC INTM" ) ; /* enable interupts */ 



/* Wait for the tach to go high */ 
while (<(Cmd Bits & Tach Bit) ~ 0) && < 2500)) Delay(l): 



30 for (i - 0: i < 8: i++) 

{ 

Delay(50): 

Do_Jumpback(Seek_In) : 

PeaktoPeak += ( (MaxRPP - MinRPP) » 5); 

35 } 

for (i =0; i. < 8; i++) 

{ 



/* Peak to peak / 32 */ 



L 



w 
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De1ay(50): 

Do_Jumpback(Seek_Out) : 

PeaktoPeak += ((MaxRPP - MinRPP) » 5): /* Peak to peak / 32 */ 

} 

return(PeaktoPeak) : /* Return the average pk-pk value/2 */ 



} 



25 



■A* A "ft ifc A'AttA A" A"TfcTfc"A"Tfc AAAAAAAAAAAA'A "A'tA"A7'A""A"A"A""A'"A""A' 'AAAAAAAAAAAAAAAAAAAA'AAAAAAAAAAA'AA'A'A'AA' A'^A 1 "fcfc 

Interupt. asm 

DSP Interupt handling routines for the 4x 5.25" 
562096 
8/12/93 



Program Name 
Description 
Part Number 
Date 
0/S 

Compiler - 
Support Packages 
Author _ 

Required Files 

Hardware Required 
Install. Instr. 
Operating Instr. 



N/A 

TI TMS320C2x/C5x Compiler. #TMDS3242855-02.Rel . 6.0 
N/A 

Dave Schell 

Dr i ve . c . Interupt . asm . C50_i nit . asm . Seek . c . Dr i ve . h 

Recal .c 

Part # XXXXXX 

Link in with Drive code 

N/A 



Rev History 

Date Rev 
4/14/94 XA 



C# Init 
00 DLS 



Change Description 
Initial Release 



30 



.title "Processor Interupt Handlers' 



.length 60 



.mmregs 
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. def I SRI . I SR2 . CMD_I nt r . Ti mer 

. def Tach . 01 d_Tach_Ti me ._Tach jTi me 

. def _TachUpLi mi t . _TachLowLi mi t 

.def . JO, XMT . TDMRCV . TDMXMT . TRP . NMISR 

.def Count 20 LSW. Count 20 MSW. Cmd Bits. CMD Buffer 
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. def _Fi ne_DAC._Crs_DAC._ReadLS_DAC._ReadMS_DAC._Wri te_DAC 

. def _Foc_LS_DAC._Foc_MS_DAC._Spare_DAC._Track_Cnt._SPC 

.def _Int_QSum._Int_Fine._Int_FwdSen._Int_Crs ,_Int_Focus ,_Int_Test 

. def _Stat_Buf f er , _Cmd_Buf f_Poi nt ._Ctr l_Image ._Ct rl _Port . Si gn_Bi t 

. def _QSum_Zero . _Fi ne_Zero . _Focus_Zero . _FwdSen_Zero ._Cr s_Zero 

.def _FocMS_Image._FocLS_Image._FineDacImage._CrsDacImage 

. def Focus_Nl . Focus_N2 . Focus_N3 . Focus_D2 . Focus_D3 . Focus_G 

. def Fi ne_Nl . Fi ne_N2 . Fi ne_N3 . Fi ne_D2 . Fi ne_D3 . Fi ne_G 

. def Crs_Nl . Crs_N2 . Crs_N3 . Crs_D2 . Crs_D3 . Crs_G . Pi n_G 

. def _Debug_Ram . Focus_Er ror .01 d_Focus_l . _Fi neDacZero . _Cr sDacZero 

.def Foe Err Cnt. Focus Limit. Fine Err Cnt. Fine Limit 
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: I/O Definition 








_SPC 


.set 


00022h 


: Serial Port Control Register 




Cmd_Port 


.set 


00050h 


:80188/DSP Communication Port 




_Ctrl_Port 


.set 


00051h 


:I/0 Control Port, laser. Power Amps 




_Track_Cnt 


.set 


00051h 


: Track crossing counter read port 


20 


ADC_Data 


.set 


00053h 


:MP87099 ADC Data 




ADC_Addr 


.set 


00053h 


:MP87099 ADC Address 




Clock_High 


.set 


00056h 


:Read to take ADC Clock High 




Clock_Low 


.set 


00057h 


:Read to take ADC Clock Low 




_Fine_OAC 


.set 


00058H 


:7228 fine current DAC 


25 


_Crs_DAC 


.set 


00059H 


:7228 Coarse current DAC 




_ReadLS_DAC 


.set 


0005AH 


:7228 Laser Read current DAC 




_ReadMS_DAC 


.set 


0005BH 


:7228 Laser Read current DAC 




_Write_DAC 


.set 


0005CH 


:7228 Laser Write current DAC 




_Foc_LS_DAC 


.set 


0005DH 


:7228 focus current DAC 


30 


_Foc_MS_DAC 


.set 


0005EH 


;7228 focus current DAC 




_Spare_DAC 


.set 


0005FH 


;7228 Spin current DAC 




BitO 


set 


15 


:Bit zero in BIT test is a 15 
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Bitl 


set 


14 


:Bit 1 in BIT test is a 14 




Bit2 


set.. 


1.3 






Bit3 


set 


12 
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10 



15 



Bit4 


.set 


11 


Bit5 


.set 


10 


Bit6 


.set 


9 


Bit7 


.set 


8 


Bit8 


.set 


7 


Bit9 


.set 


6 


BitlO ' 


.set 


5 


Bitll 


.set 


4 


Bitl2 


. set 


3 


Bitl3 


.set 


2 


Bit 14 


.set 


1 


Bitl5 


.set 


0 


SBL 


. set 


5 


CBL 


.set 


10 



; Bit 15 in BIT test is a 0 

; Status Buffer Length 
[Command Buffer Length 



Analog to Digital Converter constants 



Focus_ADC .set 00000H 

QSum_ADC .set 00001H 

20 Crs_ADC .set 00002H 

Fine_ADC .set 00003H 

FwdSen_ADC .set 00004H 

Test ADC .set 00005H 



Address zero 
Address one 
Address two 
Address three 
Address four 
Address five 



25 



MaxPos 
MaxNeg 
Min QSum 



.set 
.set 
.set 



07FFFH 
08000H 
00240H 
set 00004H 
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Max_Bad_Samples 
Ref Select .set 00004H 



Max Positive value for DAC images 
Max Negative value for DAC images 
Minimum QSum before switching refs 
Number of bad samples before Errors Flags 

;The reference select bit of Ctrl Port 



: Timer interupt variables 

_Count_20_LSW .usect Time_Ram.l :20us counter LSWord. incremented by timer 

35 _Count_20_MSW .usect Time_Ram.l :20us counter MSWord. incremented by timer 

_Int_QSum . usect. Time_Ram.l : Interrupt Quad Sum Value 

_Int_Focus .usect Time_Ram.l ; Interrupt Focus Value 
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Focus_Error 


.usect 


Time_ 


Ram. 1 


;_Int_Focus - Zero Offset 




01d_Focus_l 


.usect 


Ti me_ 


_Ram.l 


;and old focus value 




01dJ r ocus_2 


.useet 


Time_ 


_Ram . 1 


;and old focus value 




__FocLS_Image 


.usect 


Time_ 


_Ram . 1 


; Focus LS DAC memory image for capture 


5 


_FocMS_Image 


.usect 


T1me_ 


Ram. 1 


; Focus DAC memory image for servos 




01d_FocDac 


.usect 


Time_ 


_Ram.l 


; Focus DAC memory image 




Focus_Nl 


.usect 


Time_ 


Ram . 1 


; Focus Loop Constants. Numerator z"0 




Focus_N2 


.usect 


Time_ 


_Ram . 1 


: Focus Loop Constants. Numerator z"-l 




Focus_N3 


.usect 


Time_ 


_Ram. 1 


: Focus Loop Constants. Numerator z^-2 
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Focus_D2 


.usect 


Time_ 


_Ram . 1 


; Focus Loop Constants. Denominator z^-1 




Focus_D3 


.usect 


Time_ 


_Ram. 1 


: Focus Loop Constants. Denominator z"-2 




Focus_G 


.usect 


Ti me_ 


_Ram . 1 


: Focus Loop Constants. Gain 




_Foc_Err_Cnt 


.usect 


Time_ 


_Ram. 1 


; Focus Sample out of spec counter 




_Focus_Limit 


.usect 


Time_ 


_Ram. 1 


: Focus Error In Spec Limit 
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_Int_Fine 


.usect 


Time_ 


_Ram. 1 


: Interrupt Fine Value 




Fine_Error 


.usect 


Time_ 


_Ram. 1 


:_Int_Fine - Zero Offset 




01d_Fine_l 


.usect 


Time_ 


_Ram.l 


:and old Fine value 




01d_Fine_2 


.usect 


Time_ 


_Ram. 1 


;and old Fine value 




_FineDacImage 


.usect 


Time_ 


_Ram . 1 


;Fine DAC memory image 
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Old^FineDac 


.usect 


Time_ 


_Ram. 1 


;Fine DAC memory image 




_FineDacZero 


.usect 


Time_ 


_Ram. 1 


:Fine DAC Zero or Seek Accel Value 




Fine_Nl 


.usect 


Time_ 


_Ram.l 


;Fine Loop Constants. Numerator z"0 




Fine_N2 


.usect 


Time_ 


_Ram. 1 


;Fine Loop Constants. Numerator z^-1 




Fine_N3 


.usect 


Time_ 


_Ram. 1 


:Fine Loop Constants. Numerator z^-2 
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Fine_D2 


.usect 


Time_ 


_Ram . 1 


:Fine Loop Constants. Denominator z~-l 




Fine_D3 


.usect 


Time_ 


_Ram, 1 


:Fine Loop Constants. Denominator z"-2 




Fine_G 


.usect 


Time_ 


_Ram . 1 


;Fine Loop Constants. Gain 




_Fine_Err_Cnt 


.usect 


Time_ 


Ram.l 


:Fine Sample out of spec counter 




_Fine_Limit 


.usect 


Time_ 


_Ram. 1 


;Fine Error In Spec Limit 
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_Int_Crs 


.usect 


Ti me_ 


Ram.l 


interrupt Coarse Value 




Crs_Jrror 


.usect 


Time_ 


Ram. 1 


;_Int_Crs - Zero Offset 




01d_Crs_l 


.usect 


Time_ 


Ram . 1 


;and old Coarse value 




01d_Crs_2 


.usect 


Time_ 


_Ram.l 


:and old Coarse value 




_CrsDacImage 


.usect 


Time_ 


Ram.l 


.Coarse DAC memory image 
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01d_CrsDac 


.usect 


Time_ 


Ram . 1 


; Coarse DAC memory image 




_CrsDacZero 


. usect 


.Time_ 


_Ram.l 


: Coarse DAC Zero or Seek Accel Value 




CrsJJl 


.usect 


Time_ 


_Ram.l 


:Coarse Loop Constants. Numerator z~0 
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Crs_N2 


■.usect 


Time_ 


_Ram 


1 


Coarse Loop Constants. 


Numerator z^-1 


Crs_N3 


.usect 


Time_ 


_Ram 


1 


Coarse Loop Constants. 


Numerator z"-2 


Crs_D2 


. usect 


Time_ 


Ram 


1 


Coarse Loop Constants. 


Denominator z"-l 


Crs_D3 


.usect 


Time_ 


Ram 


1 


Coarse Loop Constants. 


Denominator 


Crs_G 


.usect 


Time_ 


_Ram 


1 


Coarse Loop Constants. 


Gain 


Pin_G 


.usect 


Time_ 


Ram 


1 


Pinning Loop Constant. 


Gain 


_Int_FwdSen 


.usect 


Ti me_ 


_Ram 


1 


Interrupt Forward Sense Value 


_Int_Test 


.usect 


Time_ 


_Ram 


1 


Interrupt Test Value 




_FwdSen_Zero 


.usect 


Time_ 


_Ram 


1 


ADC Forward Sense Value with the laser off 


_QSum_Zero 


. usect 


Time_ 


Ram 


1 


ADC Quad Sum Value with the laser off 


_Fine_Zero 


.usect 


Time_ 


_Ram 


1 


ADC Tracking Value with the laser off 


_Focus_Zero 


.usect 


Time_ 


_Ram 


1 


ADC Focus Value with the laser off 


_Crs_Zero 


.usect 


Time_ 


_Ram 


1 


ADC Postion Error zero 


value 


Sign_Bit 


.usect 


Time_ 


_Ram 


1 


Sign Bit value stored here (08000h) 


Temp_l 


.usect 


Time_ 


_Ram 


1 


Temp Value 




Temp_2 


.usect 


Time_ 


Ram 


1 


Temp Value 




_Debug_Ram 


.usect 


Time_ 


Ram 


50. 


Debug Ram Area 
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25 



30 



; Command interupt variables 
OldAR .usect Params.l 

Cmd Bits .usect Params.l 



Old AR storage location for interupts 
Register to signal a command is ready 
Bit 0 - 1 - Command Ready 
Bit 1 - Old Direction Bit 
Bit 2 - 0 - LSByte. 1 - MSByte 
Bit 3 - Focus Sample available 
Bit 4 - Fine Sample available 
Bit 5 - Coarse Sample available 
Bit 6 - Quad Sum Sample available 
Bit 7 - Laser Sense Sample available 
Bit 8 - Fine I/Test Sample available 
Bit 9 - Tach Pulse happened 
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_Ctrl_Image .usect Params.l 
Cmd Buff Point .usect Params.l 



: memory image of the Control Port 
: Storage for cmd pointers 



Stat Buffer .usect Time Ram.SBL : Status Buffer. Length = SBL 



CMD Buffer 



.usect Time Ram.CBL 
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; Command Buffer. Length = CBL 



OldJachJTime 
_Tach_Time 
JTachUpLimit 
TachLowLimit 



.usect Params.l 

.usect Params.l 

.usect Params.l 

.usect Params.l 



Last Tach pulse time tick 
Delta Tach Time 
Tach pulse Upper time limit 
Tach pulse Lower time limit 



10 



15 



20 



25 



30 
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.text 
I SRI RETE 
ISR2 RETE 

******** -k A A A A A A.-*** 



: INIT1- Track Crossing Signal 
: INIT2- (Should not happen) 



Spindle Motor Tach Interrupt Handler. Set the One_Rev bit 
Tach 







: INIT3- (Tach Pulse) 


LAMM 


_Cmd_Bits 


:Tell Kernel a Tach Pulse Happened 


OR 


#00200h 


:Set the Tach Pulse bit 


SAMM 


_Cmd_Bits 


;Save the new command bits 


LDPK 


_Count_20_LSW 


; Point to the timer interupt page 


LACL 


_Count_20_LSW 


:Get the current timer value 


LDPK 


01d_Tach_Time 


;Point to. the Tach time 


SUB 


01d_Tach_Time 


:Subtract the old Value 


SACL 


_Tach_Time 


:Save the delta value 


ADD 


OldJachJTime 


: Restore the new time value 


SACL 


01d_Tach_Time 


;Save it in the old value 


RETE 







* * A A A A A ******* HA A * ********** * A A A k * ******-* 

Timer Interrupt Handler. All Real Time Servos and ADC's are done here! 

★* AAAAAAAAAAAAA A A ******************** * * * * AAA k*** 

Only do this if Iscounter rolled over 



MSWJTimeJick 
LACL 
ADD 
SACL 
B 



Increment the 20 us counter 



_Count_20_MSW 

-til 
7rl 

_Count_20_MSW :Save it 

Test_Ti me JDdd : Coni tnue 

: Actual start of the timer interupt routine 
Timer 
-.debug 

LAMM Ctrl Image : Start of interrupt 



1 
1 
1 
4 
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OR #02 

SAMM _Ctrl_Port 

SAMM Ctrl Image 



; Start of interrupt 



debug 



Start of the Focus ADC Conversion and Compensation Loop 



10 



Focus JStart 

: Do the Focus Loop 

LACL #Focus_ADC 
SAMM ADC_Addr 
: Update the counter while waiting for 
LDPK _Count_20_LSW 
Count 20 LSW 
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20 



25 



30 
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LACC 
ADD 
SACL 
BCND 
Test_Ti me_0dd 
BIT 
BCND 
LAMM 
OR 

SAMM 
8 

0DD_Count 

NOP 

SAMM 

LAMM 

OR 

NOP 

Foc_B_l 

SAMM 

SAMM 

NOP 

SAMM 

LAMM 

XOR 



_Count_20_LSW 
MSW_Time_Tick.EQ 

_Count_20_LSW.BitO 

ODD_Count.TC 

_Cmd_Bi ts 

#00038h 

Clock_High 

Foe B 1 



Clock_High 
Cmd Bits 



Clock_Low 
_Cmd_Bi ts 

Clock_High 

ADCJ)ata 

Sign_Bit 



Load the address 

Tell the converter conversion address 
the conversion 

Point to the timer interupt page 
Increment the 20 us counter 



If Counter rolled over inc MSWord 



See if even or odd count 1 
Odd-Fwd Sense. Even-Coarse Loop 2.4 

Update Command Bits with Sample Data 1 

Coarse. Fine. Focus available 2 

Take the converter clock high 1 

Do the Even Stuff 4 

One extra clock for ADC timing 1 

Take the converter clock high 1 

Update Command Bits with Sample Data 1 

Sense. Fine. Focus. QSum available 2 

One extra clock for ADC timing 1 



:Take the converter clock low 
:Save the results 



Take the converter clock high 2 
Get the result of the conversion 1 
Make it a signed integer 1 
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Debug 



Debug 



AND 
SACL 

XOR 

SAMM 

XOR 

SUB 

SACL 

SPM 

ZAP 

LT 

MPY 

LTD 

MPY 

APAC 

SACH 

ZAP 

LT 

MPY 

LTD 

MPY 

LTD 



#0FFC0h 
_Int_Focus 

Sign_Bit 

_Spare_DAC 

Sign_Bit 

_Focus_Zero 
Focus_Error 
1 

01d_FocDac 
Focus_D3 
_FocMS_Image 
Focus_D2 

Temp_l 

01d_Focus_2 
Focus_N3 
01d_Focus_l 
Focus_N2 
Focus Error 



:Clear the 6 LSBits 
:Save Focus Error 

:Add in the zero offset (8000H) 

:Add in the zero offset (8000H) 

Save the Focus Error 
Focus DAC - Zero Value 
Set for fraction multiply 

Vout(N-2) 

Multiply by a constant 
Vout(N-l) > vout(N-2) 
Multiply by a constant 
Accumulate the results 
(D2*Vout(N-l)+D3*Vout(N-2) > temp 

Vin(N-2) 

Multiply by a constant 
Vi(N-l)>Vi(N-2) acc=Vi(n-2)*N3 
Multiply by a constant 
Vi (N)>Vi(N-l) acc=acc+Vi(n-l)*N2 



Focus Error values are updated. Update the focus DAC if the loop is closed 



BIT 
BCND 

MPY 

APAC 

SACH 

LT 

SPM 

MPY 

LACC 

APAC 

XOR 

SAMM 



_Stat_Buffer.Bit8 
Focus_Open.NTC 

Focus_Nl 

Temp_2 
Temp_2 
0 

Focus_G 
Temp_l 

Sign_Bit 
Foe MS DAC 



:See if the focus loop is closed 
: Branch if the loop is not closed 

preg = Vi (n)*Nl 

Acc = Acc + Vi(n)*Nl 

Save result 

Load the TReg 

Set for regular multiply 

PReg = K2*(K3*Vin(N-l) - Vin(N)) 

acc = (D2*Vout(N-l)+D3*Vout(N-2) 

acc = G*Numerator- Denominator 

Add in the zero offset (8000H) 

Write out the value 
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XOR . Sign_Bit 
SACL _FocMS_Image 
;Loop done unless there is an overflow 
BSAR 15 

Foe Pos OV.GT 



Foe Pos OV 



15 Foe Neg OV 



BCND 
CMPL 
BCND 
B 

/ 

LACC 

SACL 

XOR 

SAMM 

B 

/ 

LACC 

SACL 

XOR 

SAMM 

B 



Foc_Neg_OV.GT 
Fine_Start 

#MaxPos 

_FocMS_Image 

Sign_Bit 

_Foc_MS_DAC 

Fine_Start 

#MaxNeg 
_FocMS_Image 
Sign_Bit 
_Foc_MS_DAC 
Fine Start 



Set the bit back 
Save the image 

sign extend the 32 bit number 
If greater than zero. + overflow 
Ones complement the Acc 
If greater than zero. - overflow 
Do the quad sum loop 

Write Out Max Positive value 
Save the image 

Add in the zero offset (8000H) 
Write out the value 



Write Out Max Positive value 
Save the image 

Add in the zero offset (8000H) 
Write out the value 



End of the Focus ADC Conversion and Compensation Loop 
Start of the Fine Loop ADC Conversion and Compensation Loop 



#Fine_ADC 
ADC_Addr 
#4 

Fine Clk High 



FocusJDpen 

LACL 
SAMM 
RPT 
NOP 
B 

Fine_Start 

: Do the Fine Tracking Loop 
LACL #Fine_ADC 
SAMM 
LACC 
ABS . 
SUB 



1 
1 

1 
2 
1 
2 
4 

2 
1 
1 
1 
4 

2 
1 
1 
1 
4 



ADC_Addr 
Focus_Error 

Focus Limit 



Focus Loop Open. No Error Check 
TES address 1 
Tell the converter conversion address3 
Delay 6 clocks 6 

;4 more clock of delay 4 



TES address 1 

Tell the converter conversion address3 

Get the Focus Error Value 1 

Get the magnitude 1 

Compare to out of focus limit 1 



BCND Focus__In_Spec.LEQ 

Focus_Out_Spec 

LACL _Foc_Err_Cnt 

SUB #Max_Bad_Sampl es 

BCND Fine_Clk_High.GEQ 

LACL _Foc_Err_Cnt 

ADD #1 

SAMM Clock_High 

SACL __Foc_Err_Cnt 

SUB #Max_Bad_Samples 

BCND Fine_Clk_Low.LT 

SAMM Clock_Low 

LACL _Stat_Buffer 

OR #0400H 

SACL _Stat_Buffer 

: Debug. In the future, set the 188 

B Fine_Clk_H2 

Dec_Foc_Cnt 

SAMM ClockJHigh 

SUB #1 

SACL _Foc_Err_Cnt 

NOP 

NOP 

SAMM Clock_Low 

B Fine_Clk_H2 
Focus_In_Spec 

LACL _Foc_Err_Cnt 

BCND Dec_Foc_Cnt . NEQ 
NOP 

Fine_Clk_High 

SAMM Clock_High 

RPT #1 

NOP 

Fine_Clk_Low 

SAMM Clock_Low 

NOP . 

NOP 
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: Branch if i'n spec 4/2 

;Get The Focus Error Count 1 

;See if at max Number of bad Samples 1 

;If at Max then continue 4/2 

:Get The Focus Error Count 1 

increment the Count 1 

;Take the converter clock high 1 

;Save the Incremeted Value 1 



See if at max Number of bad Samples 1 

4/2 
1 
1 
2 
1 

4 

;Take the converter clock high 1 

: Decrement the Focus Error Count 1 

:Save the Decremeted Value 1 

: Del ay 1 Clock 1 

: Del ay 1 Clock 1 

:Take the converter, clock low 1 

:Take the Clock Bit Low 4 

;Get the Focus Error Count 1 
:If not Zero then decrement 4/2 

;Take the converter clock high 1 
: Del ay 3 clocks 3 

:Take the converter clock low 1 
: 1 

; 1 



: Continue if not at max count 
:Take the converter clock low 
:Set the Bad Focus Bit 
:Set the Bit 
:Save the Result 
interupt here 
: Continue 
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Fine_Clk_H2 

SAMM 



Clock_High 



Take the converter clock high 





LAMM 


ADC_Data 


Get the Data 




XOR 


Si gn_Bi t 


Make it a signed integer 


c 
O 


SACL 


_Int_Fine 


Save Fine Error Value 




SUB 


_Fine_Zero 


Save the Fine Error 




SACL 


Fine_Error 


Fine Error - Zero Value 




:Set up for fixed Reference Conversions 




LAMM 


_Ctrl_Image 




1 U 


OR 


#Ref_Select 


Fixed Reference Bit 




SAMM 


_Ctrl_Image 






SAMM 


_Ctrl_Port 






SPM 


1 


Set for fraction multiply 




:Do the Loop Compensation 




1 D 


ZAP 








LT 


01d_FineDac 


Vout(N-2) 




MPY 


Fi ne_D3 


Multiply by a constant 




LTD 


_FineDac Image 


Vout(N-l) > Vout(N-2) 




MPY 


Fine_D2 


Multiply by a constant 


on 


APAC 




Accumulate the results 




SACH 


Temp_l 


(D2*Vout(N-l)+D3*Vout(N-2) > temp 




ZAP 








LT 


01d_Fine_2 


Vin(N-2) 




MPY 


Fine_N3 


Multiply by a constant 
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LTD 


01d_Fine_l 


Vi(N-l)>Vi(N-2) acc=Vi(n-2)*N3 




MPY 


Fine_N2 


Multiply by a constant 




LTD 


Fine Error 


Vi(N)>Vi(N-l) acc=acc+Vi (n-l)*N2 



2 
3 



:Fine Error values are updated. Update the fine DAC if the loop is closed 



30 
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BIT _Stat_Buffer.Bit7 

BCND FwdSenOrCrs.NTC 

MPY Fine_Nl 
APAC 

SACH Temp_2 

LT Temp_2 

SPM 0 
MPY . Fine_G 

LACC Temp_l 



See if the fine loop is closed 

Branch if the loop is not closed 

preg = Vi (n)*Nl 

Acc = Acc + Vi(n)*Nl 

Save result 

Load the TReg 

Set for regular multiply 

PReg = K2*(K3*Vin(N-l) - Vin(N)) 

acc = (D2*Vout(N-l)+D3*Vout(N-2) 



1 



APAC 
ADD 
SACL 
XOR 
SAMM 
XOR 
1 



_FineDacZero 

_FineDacImage 

Sign_Bit 

_Fine_DAC 

Sign_Bit 
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Loop done unless there is an overflow 
BSAR 15 

Fine Pos_0V.GT 



15 
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BCND 
CMPL 
BCND 
B 

Fine_Pos_OV 

LACC 

SACL 

XOR 

SAMM 

B 

Fine_Neg_OV 

LACC 
SACL 
XOR 
SAMM 



Fine_Neg_OV.GT 
FwdSenOrCrs 

#MaxPos 
_FineDac Image 
Sign_Bit 
_Fine_DAC 
FwdSenOrCrs 

#MaxNeg 
_FineDac Image 
Sign_Bit 
Fine DAC 



B42 

acc = G*Numerator-Denominator 1 

Add the DAC Zero ValueCor Seek Accel )1 

Save the image 1 

Toggle the MSBit 1 

Write out the value 1 

Toggle the MSBit back 1 



sign extend the 32 bit number 1 

If greater than zero. + overflow 2 

Ones complement the Acc 1 

If greater than zero. - overflow 2 

Do the quad sum loop 4 

Write Out Max Positive value 2 

Save the image 1 

Toggle the MSBit 1 

Write out the value 1 

4 

Write Out Max Positive value 2 

Save the image 1 

Toggle the MSBit 1 

Write out the value 1 
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End of the Fine ADC Conversion and Compensation Loop 



Fwd_Sen_Addr 

: Get the Quad Sum Value 
30 LACC #QSum_ADC 

SAMM ADC_Addr 
B FwdSen Crs ADC 



Get the Quad Sum Address 
Tell the converter to start 
Continue Conversion/Error Checking 



FineClosed 
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LACC 

ABS 

SAMM 



; Error Check starts here if the Fine loop is closed 



Fine Error 



Clock High 



Get the Fine Error Value 
Get Magnitude of the error 
Take the converter clock high 
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SUB 


_Fine_Limit 


;Subtract the Fine error limit 






BCND 


Fine_Out_Spec.GT 


: Branch if out of Spec 






Fine_In_Spec 










LACL 


_Fine_Err_Cnt 


;Get the error count 


1 


5 


SAMM 


Clock_Low 


;Take the converter clock low 


1 




BCND 


Dec__Fine_Cnt.NEQ 


;If not Equal then Decrement 


2 




SAMM 


Clock_High 


;Take the converter clock high 


2 




LAMM 


ADC_Data 


;Get the Data 


3 




SACL 


Temp_2 


;Save the Results in temp 2 




10 


B 

Dec_Fine_Cnt 


Finish_Fwd_Crs 


:Finish the forward sense or coarse 






SUB 




;If not Equal then Decrement 


1 




SACL 


_Fine_Err_Cnt 


:Save the Result 


1 


15 


SAMM 


ClockJHigh 


;Take the converter clock high 


2 




LAMM 


ADC_Data 


:Get the Data 


3 




SACL 


Temp_2 


;Save the Results in temp 2 






B 


Finish_Fwd_Crs 


; Finish the forward sense or coarse 


4 


20 


Fine_Qut_Spec 










SAMM 


Clock_Low 


;Take the converter clock low 


1 




NOP 










NOP 










SAMM 


ClockJHigh 


:Take the converter clock high 


2 


25 


LAMM 


ADC_Data 


;Get the Data 


3 




SACL 


Temp_2 


:Save the Results in temp 2 


1 




LACL 


_Fi ne_Err_Cnt 


:Get the error count 


1 




SUB 


#MaxJJad_Samples 


:See if at max number of bad samples 


1 




BCND 


Finish_Fwd_Crs.GEQ 


:If at max then continue 


4/2 


30 


LACL 


_Fine_Err_Cnt 


;else increment the error count 


1 




ADD 


#1 


: increment 


1 




SACL 


_Fine_Err_Cnt 


:Save the count 


1 




SUB 


#Max_Bad_Samples 


;Test if now at max count 


1 




BCND 


Finish__Fwd_Crs .LT 


; continue if not a max count 


4/2 


35 


LACL 


_Stat_Buffer 


:else set the fine tracking error bit 1 




OR 


. #1000H 


:Set the Bit 


2 




SACL 


_Stat_Buffer 


;Save the result 


1 
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Debug, in the Future set the 188 interupt bit here 

B Finish Fwd Crs :Finish the forward sense or coarse 



FwdSenOrCrs 

; Do the Coarse Or Forward Sense Conversion 

BIT _Count_20_LSW.BitO ;See if even or odd count 

BCND Fwd_Sen_Addr .TC : Odd- Fwd Sense. Even -Coarse Loop 

: If not forward sense loop then do the coarse loop 



LACC 

10 SAMM 
RPT 
NOP 

FwdSen_Crs_ADC 
BIT 

15 BCND 
RPT 
NOP 
SAMM 
RPT 

20 NOP 
SAMM 
NOP 
NOP 
SAMM 

25 LAMM 
SACL 

Finish_Fwd_Crs 
LACC 
BIT 

30 BCND 
XOR 
SACL 
SUB 
SACL 

35 BIT 
BCND 
SPM 



#Crs_ADC 
ADC Addr 



7T-L 



_Stat_Buffer.Bit7 
FineClosed.TC 

Clock_High 

7Tl 



Clock Low 



Clock_High 

ADC_Data 

Temp_2 

Temp_2 

_Count_20_LSW.BitO 

Fwd_Sense.TC 

Sign_Bit 

_Int_Crs 

_Crs_Zero 

CrsJIrror 

_Stat_Buffer.Bit5 

DoPin.TC 

1 



;Get the Coarse conversion command 
:Tell the converter to start 



Start fine loop error checking !!! 
See if the fine loop is closed 1 
Branch if the loop is closed 4/2 
No error checking if loop is open 

:Take the converter clock high 1 



:Take the converter clock low 



Take the converter clock high 2 
Get the Data 3 
Save the value 

Restore data 

See if even or odd count 
Odd-Fwd Sense. Even-Coarse Loop 
Make it a signed integer 
Save Coarse Error Value 
Subtract the zero value 
Crs DAC - Zero Value 
See if the Pinning loop is close 
Branch if pinning is closed 2 
Set for fraction multiply 1 
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ZAP : 

LT 01d_CrsDac :Vout(N-2) 

MPY Crs_D3 ; Multiply by a constant 

LTD _CrsDacImage :Vout(N-l) > Vout(N-2) 

5 MPY Crs_D2 :Mult1ply by a constant 

APAC ; Accumulate the results 

SACH TempJL ; (D2*Vout(N-l)+D3*Vout(N-2) > temp 

ZAP : 

LT 01d_Crs_2 :Vin(N-2) 

10 MPY Crs_N3 :Multiply by a constant 

LTD 01d_Crs_l ; Vi (N-l)>Vi (N-2) acc=Vi (n-2)*N3 

MPY Crs_N2 [Multiply. by a constant 

LTD Crs_Error : Vi (N)>Vi (N-l) acc=acc+Vi (n-l)*N2 
: Crs Error values are updated. Update the Crs DAC if the loop is closed 

15 BIT _Stat_Buffer.Bit6 ;See if the Coarse loop is closed 

BCND SwitchRef .NTC ; Branch if the loop is not closed 

MPY Crs_Nl ;preg = Vi(n)*Nl 

APAC :Acc = Acc + Vi(n)*Nl 

20 SACH Temp_2 :Save result 

LT Temp_2 ;Load the TReg 

SPM 0 :Set for regular multiply 

MPY Crs_G ;PReg - K2*(K3*Vin(N-l) - Vin(N)) 

LACC TempJL :acc - (D2*Vout(N-l)+D3*Vout(N-2) 

25 APAC ;acc = (G*Numerator-Denominator)/4 

SFL : Shi ft left. Multiply by 2 

SFL ; Shi ft left. Multiply by 4 

ADD _CrsDacZero ;Add the DAC Zero Value 

XOR Sign_Bit :Add in the zero offset (8000H) 

30 SAMM _Crs_DAC : Write out the value 

XOR Sign_Bit :Set the bit back 

SACL __CrsDacImage :Save the image 
:Loop done unless there is an overflow 

BSAR 15 :sign extend the 32 bit number 

35 BCND Crs_Pos_0V,GT :If greater than zero. + overflow 

CMPL m . . . :0nes complement the Acc 

BCND Crs_Neg_0V.GT :If greater than zero. - overflow 



B 

Crs_Pos_OV 

LACC 
SACL 

5 XOR 
SAMM 
B 

Crs_Neg_OV 

LACC 

1 0 SACL 
XOR 
SAMM 
B 

: Crs Error val 
15 DoPin 

NEG 
SACL 
SPM 
ZAP 

20 LT 
MPY 
LTD 
MPY 
APAC 

25 SACH 
ZAP 
LT 
MPY 
LTD 

30 MPY 
LTD 



SwitchRef 

#MaxPos 
_CrsDac Image 
Sign_Bit 
_Crs_DAC 
SwitchRef 

#MaxNeg 
_CrsDac Image 
Sign_Bit 
_Crs_DAC 
SwitchRef 
ues are updated. 



Crs_Error 
1 

01d_FineDac 
Crs_D3 

_FineDac Image 
Crs_D2 

Temp_l 

01 d_Crs_2 
Crs_N3 
01 d_Crs_l 
Crs_M2 
Crs Error 
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:Do the quad sum loop 

Write Out Max Positive value 
Save the image 

Add in the zero offset (8000H) 
Write out the value 



Write Out Max Positive value 
Save the image 

Add in the zero offset (8000H) 
Write out the value 



Do the Pinning Loop 



Negate the Coarse Error 

Crs DAC - Zero Value 

Set for fraction multiply 

Vout(N-2) 

Multiply by a constant 
Vout(N-l) > Vout(N-2) 
Multiply by a constant 
Accumulate the results 
(D2*Vout(N-l)+D3*Vout(N-2) > temp 

Vin(N-2) 

Multiply by a constant 
Vi(N-l)>Vi(N-2) acc=Vi(n-2)*N3 
Multiply by a constant 
Vi(N)>Vi(N-l) acc=acc+Vi(n-l)*N2 



2 
1 
1 
1 
4 

2 
1 
1 
1 
4 



35 



MPY 

APAC 

SACH 

LT 

SPM 



Crs_Nl 

Temp_2 
Temp_2 
0 



preg = Vi (n)*Nl 

Acc = Acc + Vi(n)*Nl 

Save result 

Load the TReg 

Set for regular multiply 
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10 



MPY 

LACC 

APAC 

SFL 

SFL 

ADD 

XOR 

SAMM 

XOR 

SACL 



Pin_G 
Temp_l 



_FineDacZero 
Sign_Bit 
_Fi ne_DAC 
Sign_Bit 
_FineDac Image 



15 



20 



:Loop done unless there is an overflow 

BSAR 15 

BCND Pin_Pos_OV.GT 
CMPL 

BCND Pin_Neg_OV.GT 

B SwitchRef 

LACC #MaxPos 

SACL _FineDac Image 

XOR Sign_Bit 

SAMM _Fi ne_DAC 

B SwitchRef 

Pin NegOV 



Pin Pos OV 



PReg = K2*(K3*Vin(N-l) - Vin(N)) 

acc = (D2*Vout(N-l)+D3*Vout(N-2) 

acc = (G*Numerator-Denominator)/4 

Shift left. Multiply by 2 

Shift left. Multiply by 4 

Add the DAC Zero Value 

Add in the zero offset (8000H) 

Write out the value 

Set the bit back 

Save the image 

sign extend the 32 bit number 
If greater than zero. + overflow 
Ones complement the Acc 
If greater than zero. - overflow 
Do the quad sum loop 

Write Out Max Positive value 
Save the image 

Add in the zero offset (8000H) 
Write out the value 



25 



30 



35 



LACC sMaxNeg 

SACL _FineDacImage 

XOR Sign_Bit 

SAMM _Fine_DAC 

B SwitchRef : 
: Read the forward sense and quad sum values 
Fwd_Sense 

SACL _Int_QSum 
: Get the forward sense value 

LACC #FwdSen_ADC 

SAMM ADC_Addr 

LACL _Int_QSum 

BSAR .6 

AND #03FFH 



Write Out Max Positive value 
Save the image 

Add in the zero offset (8000H) 
; Write out the value 



Save the Quad Sum Value 



Get the Forward Sense Address 
Tell the converter to start 
Load it for modification 
Make it a 10 bit value 
Make it positive 



1 
1 
1 
1 
1 
1 
1 
1 
1 
1 

1 
2 
1 
2 
4 

2 
1 
1 
1 
4 

2 
1 
1 
1 
4 



10 



SACL 

RPT 

NOP 

SAMM 

RPT 

NOP 

SAMM 

NOP 

NOP 

SAMM 

LAMM 

BSAR 

AND 

SACL 



_Int_QSum 



Clock_High 
#1 



Clock Low 



Clock_High 
ADC_Data 

6 



#03FFH 



Int FwdSen 



15 SwitchRef 
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:Save the Forward Sense Value 
:Take the converter clock high 
:Take the converter clock low 



Take the converter clock high 

Get the result of the conversion 

Make it a 10 bit value 

Make it positive 

Save the Forward Sense Value 







LAMM 


_Ctrl_Image 


:Get the control image 






AND 


#0008h 


;See if the laser is on 






BCND 


TimeEnd. EQ 


:If laser is off don't switch ref 






LAMM 


_Ctr1_Image 


:Set up for Quad Sum Reference 


20 




AND 


#-Ref_Select 


;Clear the bit 






SAMM 


_Ctrl J>ort 


: Write it out 






SAMM 


_Ctrl_Image 






TimeEnd 










: debug 








25 




LAMM 


_Ctrl_Image 


;end of interrupt 






AND 


#0FDh 








SAMM 


_Ctrl_Port 








SAMM 


_Ctrl_Image 






; debug 








30 




RETE 




;Timer interupt processing 



35 



RCV 
XMT 

TDMRCV 
TDMXMT 



RETE 
RETE 
RETE 
RETE 



frA" A ^fc A A 



Serial Rx (Should not happen) 
Serial Xmit (Should not happen) 
TDM Serial Rx (Should not happen) 
TDM Serial Xmit (Should not happen) 

■^■"A' A A A "X - xAA'A'AAAAAAAaaAA ~tz A A A A A A 



; Command Interupt Handler. Interrupt 4 
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CMDJntr 

BCND CMD_Stat.BIO :If 810=0. then see is a command or stat 

SETC XF ;else Set the XF Bit and 

5 RETE ; Return 

CMD_Stat 

LDP #000h : Point to page 0: 

BIT TSPC.Bit8 ;Test Bit 8 of the TSPC (Direction) 

BCND Dir_Eq_High.TC :If Direction is 1 the See if Old = 1 

10 BIT _Cmd_Bits.Bitl :Test the Old Direction bit 

BCND CMD_Complete.TC : Branch if Old Dir = 1 & Dir = 0 

Next_Status :01d Dir=0.Dir=0 => ship next status: 

BIT _Cmd_Bits.Bit2 :Test the send MSByte or LSByte 

15 BCND Stat_MSB.TC : Branch MSByte then branch 

Stat_LSB 

:Note Old Status bit is set 

MAR *.AR1 :Make AR1 active 

SAR ARl.OldAR :Save AR1 

20 LAR ARl._Cmd_Buff_Point :Load the pointer into AR1 

LACC *+ :Load Status into the Accumulator 

SAMM Cmd_Port :Write Out the Status: 

SAR ARl._Cmd_Buff_Point :Save The Status Pointer 

LAR ARl.#_Cmd_Bits :Toggle the MSByte/LSByte Bit 

25 XPL #00004h.* : Toggle Bit 2 of the Cmd_Bits 

LAR ARl.OldAR : Restore AR1 

CLRC XF .Clear the Acknowledge Bit 

RETE :Exit interupt 4 

Stat_MSB 

30 MAR *.AR1 :Make AR1 active 

SAR ARl.OldAR :Save AR1 

LAR ARl._Cmd_Buff_Point :Load the pointer into AR1 

LACC *.8 :Load Status shifted 8 into the Acc. 

SACH Cmd_Port : Write Out the Status : 

35 :The Status Pointer is unchanged 

LAR . ARl .#_Cmd_Bits : Toggle the MSByte/LSByte Bit 

XPL #00004h.* : Toggle Bit 2 of the Cmd_Bits 



B50 







LAR 


ARl.OldAR 


: Restore AR1 






CLRC 


XF 


; CI ear the Acknowledge Bit 






RETE 




;Exit intempt 4 


5 


Dir_Eq_High 










n tt 

BIT 


_Cmd_Bits.Bitl 


;Test the Old Direction bit 






BCND 


New_CMD . NTC 


;Branch if Old Dir = 0 & Dir - 1 




Next_CMD 






;01d Dir=l.Dir=l => get next cmd wor 










:Note Old Status bit is set 


10 




BIT 


_Cmd_Bits.Bit2 


;Test the send MSByte or LSByte 






BCND 


CMD_MSB.TC 


; Branch MSByte then branch 




CMDJ.SB 










:Note Old 


Status 


bit is set 








MAR 


*.AR1 


Make AR1 active 


15 




SAR 


ARl.OldAR 


Save AR1 






LAR 


AR1 ._Cmd_Buf f_Poi nt 


Load the pointer into AR1 






LAMM 


Cmd_Port 


Load Command into the Accumulator 






AND 


#OOFFh 


Clear the MSBits 






OR 


* 


Or with the MSByte 


20 




SACL 




Save the command word 




:if AR1 > 


Command Buffer + Command Buffer Lenght then dec AR1 






LAR 


ARl.#_Cmd_8its 


Toggle the MSByte/LSByte Bit 






XPL 


#00004h.* 


Toggle Bit 2 of the Cmd_Bits 






LAR 


ARl.OldAR 


Restore AR1 


25 




CLRC 


XF 


Clear the Acknowledge Bit 






RETE 




Exit interupt 4 




New_CMD 












LAMM 


_Cmd_Bits 


Get the Command Bit Register 






OR 


#00006h 


Set the Old Dir and MSB/LSB bits 


30 




SAMM 


_Cmd_Bits 


Save the new command bits 






MAR 


*.AR1 


Make AR1 active 






SAR 


ARl.OldAR 


Save AR1 






LAR 


AR1 .#_CMD_Buf fer 


Load AR1 to the start of Cmd Buffer 






MAR 


*-.ARl 


Decrement the pointer 


35 




SAR 


AR1 . _Cmd_Buf f_Poi nt 


Save it in the pointer 






B 


Save CMD MSB 





CMD MSB 
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10 



15 



20 



25 



30 



35 



MAR . 

SAR 

LAR 

Save_CMD_MSB 

LACC 



*.AR1 
ARl.OldAR 

AR1 ._Cmd_Buf f_Poi nt 
Cmd Buff Point 



Make AR1 active 
Save AR1 

Load the pointer into AR1 
:6et the Pointer Value 



: Subtract the start of the buffer + Length - 1 



SUB 

BCND 

MAR 

Save_Cmd_Point 
SAR 
LACC 
SACL 

LAR 

XPL 

LAR 

CLRC 

RETE 

CMD_Compl ete 

LAMM 

OR 

AND 

SAMM 

LAMM 

AND 

SAMM 

RETE 



TRP 
NMISR 



RETE 
RETE 



#(_CMD_Buffer + CBL - 1) 

Save_Cmd_Point.GEQ : Branch if at the end of the buffer 

;else increment the pointer 



*+.ARl 

AR1 ._Cmd_Buff_Poi nt 

Cmd_Port . 8 
* 

ARl.#_Cmd_Bits 
#00004h.* 
ARl.OldAR 
XF 



_Cmd_Bits 
#00001h 
#0FFFDh 
_Cmd_Bits 
I MR 

#0FEFFh 
I MR 



Save The Command Pointer 
Get the MSByte data in Acc. shl 8 
Store the command into the buffer 
The Status Pointer is unchanged 
Toggle the MSByte/LSByte Bit 
Toggle Bit 2 of the Cmd_Bits 
Restore AR1 

Clear the Acknowledge Bit 
Exit interupt 4 



Tell Kernel a command is ready 
Set the Command Ready bit 
Clear Old Direction bit 
Save the new command bits 
Get the Interupt Mask Register 
Clear interupt 4 enable bit 
Disable interupt 4 
Exit interupt 4 

:Software trap (Should not happen) 
:NMI interupt (Should not happen) 



AAAAAAAA****AAAA*AA ' AAAAAAAAAAAAAAAAA* * ** *AA' AAAAAAAAAAAAA A AAAAAAAAAAAAAAAAAAA * 



Program Name 
Description 
Part Number 
Date 



C50_Init.asm 

DSP Initialization for 4x 5.25" 

562096 

8/12/93 
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10 



0/S 

Compi ler 

Support Packages 
Author 

Required Files 

Hardware Required 
Install. Instr. 
Operating Instr. 



Rev History 

Date Rev 
4/14/94 XA 00 



A A A A k A A'^'t^ttA 



N/A 

TI TMS320C2x/C5x Compiler. #TMDS3242855-02.Rel . 6.0 
N/A 

Oaye Schell 

Dri ve . c . Interupt . asm. C50_i ni t . asm . Seek . c . Dri ve . h 

Recal .c 

Part # XXXXXX 

Link in with Drive code 

N/A 



C# Init 



DLS 



Change Description 
Initial Release 



lr* ****** A A A * A A *-* A A * ***^******************t^****-***-A-* 



15 



include SimSet.equ 



20 



25 



30 



.title "Processor Initialization. C50_INIT.asm" 
.mmregs 

. ref ISR1 . ISR2 . Tach . CMDJntr . Timer 

. ref RCV . XMT . TDMRCV . TDMXMT .TRP.NMISR.S i gn_Bi t 

. ref jnai n ._c_i ntO ,_Count_20_LSW , - Cmd_Bi ts ._Ctrl_Image 

.ref _Stat_Buffer._Count_20_MSW._TachUpLimit ._TachLowLimit 

. ref Focus_Nl . Focus_N2 . Focus_N3 . Focus_D2 . Focus_D3 . Focus_G 

. ref Fi ne_Nl . Fi ne_N2 . Fi ne_N3 . Fi ne_D2 . Fi ne_D3 . Fi ne_G 

. ref Cr sjll . Crs_N2 . Crs_N3 . Crs_D2 . Cr s _D3 . Crs_G . Pi n_G 

.ref _FineDacZero._CrsDacZero._Foc_Err_Cnt ._Focus_Limit 

. ref _Fi ne_Er r_Cnt ,_Fi ne_Li mi t 

. def _i ni t_regs . _Vel _Tabl e . _InverseTi me . _Read_Sense 

. def _Wri te_Sense . _ReadMS Image . _ReadLSImage . _Wr i teDacImage 

.def MaxRPP. MinRPP 



35 



_Vel_Table .usect V_Table.l80h 

. bss _InverseTi me . 25 
.bss _Read_Sense.l 
.bss _Write_Sense.l 
.bss . _ReadMSImage.l 
.bss _ReadLSImage.l 



Seek Velocity Table RAM Area 
Inverse time table for seeks 
Laser Read Sense Desired Level 
Laser Write Sense Desired Level 
Laser Read DAC Bit Image 
Laser Read DAC Bit Image 
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.bss 


_WriteDacImage.l 




:Laser Write DAC 16 Bit Image 






.bss 


_MaxRPP.l 






:Max RPP Value seen during a jumpback 






.bss 


_MinRPP.l 






:Min RPP Value seen during a jumpback 


5 


: Abs(Nl)+Abs(N2) 


+Abs(N3) must be 


< 1 to prevent over flow 




: Abs(D2)+Abs(D3) 


must be < 


1 to prevent over flow 




:Vo(n)=- 


(D2*Vo(n- 


l)+UJ*VO(N- 


■2))+(- 


■l)*2*G*(0.5*(Nl*Vi(N)+N2*Vi(N-l)+N3*Vi(N-3)) 




Foc_Nl 


.set 


oi m 






Foe Loop Const. -Nl/4. -1.000*213 


10 


Foc_N2 


.set 


-877 






Foe Loop Const. -N2/4. -0.107*213 




Foc_N3 


.set 


7315 






Foe Loop Const. -N3/4. .893*213 




Foc_D2 


. set 


-lloob 






Foe Loop Const. -02. -.356*215 




Foc_D3 


.set 


-4456 






Foe Loop Const. -03. -.136*215 




Foc_G 


. set 


167 






Foe Loop Gain Const. 4*36.059(1.16??) 


15 
















:Vo(n)=- 


(D2*Vo(n- 


1 )+D3*Vo(N- 


-2))+(- 


l)*2*G*(0.5*(Nl*Vi(N)+N2*Vi(N-l)+N3*Vi(N-3)) 




Fin_Nl 


. set 


8192 






Fin Loop Const. Nl/4. 1.000*213 




Fi n_N2 


.set 


877 






Fin Loop Const. N2/4. 0 . 107*2^13 




Fin_N3 


.set 


-7315 






Fin Loop Const. N3/4. -.893*213 


20 


Fin_D2 


. set 


-11665 






Fin Loop Const. -D2. -.356*215 




Fi n_D3 


.set 


-4456 






Fin Loop Const. -D3. -.136*215 




Fi n_G 


. set 


34 






Fin Loop Gain Const. 4*8.583 




:Vo(n)=- 


(D2*Vo(n- 


l)+D3*Vo(N- 


■2))+(- 


l)*2*G*(0.5*(Nl*Vi(N)+N2*Vi(N-l)+N3*Vi(N-3)) 


25 


Cr_Nl 


.set 


8192 






Crs Loop Const. -Nl/2. (1.000/4)*215 




Cr_N2 


.set 


203 






Crs Loop Const. -N2/2. (0.02482/4)*215 




Cr_N3 


.set 


-7989 






Crs Loop Const. -N3/2. ( - .97518/4)*215 




Cr_D2 


.set 


11893 






Crs Loop Const. -02. (1.4518/4)*215 




Cr_03 


.set 


-4703 






Crs Loop Const. -D3. ( - .57412/4)*215 


30 


Cr_G 


.set 


7 






Crs Loop Gain Const. 6.991 




Pn_G 


.set 


7 






Pinning Loop Gain Const. 7.309 




V_TBL 


.sect 


" vectors' 








35 
















RESET 


B 


_c_i ntO 






:This section will be loaded in 



: program memory address Oh. 
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INT1 


B 


ISR1 


; INIT1 - begins processing here 


INT2 


B 


ISR2 


: INIT2- begins processing here 


INT3 


B 


Tach 


: INIT3- Spindle Motor Tach intr 


TINT 


B 


Timer 


;Timer interupt processing 


RINT 


B 


RCV 


: Serial Recieve processing 


XINT 


B 


XMT 


;Serial transmit processing 


TRNT 


B 


Tr\i j r\ /■* \ / 

TDMRCv 


;TDM Serial Recieve processing 


TXNT 


B 


TDMXMT 


;TDM Serial transmit processing 


INT4 


B 


CMDJntr 


:INIT4- begins processing here 




.space 


14*16 


;14 words 


TRAP 


B 


TRP 


: Software trap processing 


NMI 


B 


NMISR 


:NMI interupt processing 



15 



20 



25 



30 



35 



.text 

_init_regs CLRC OVM 
LDP #00h 
.if Simulator = 1 

; Need the next line to work with the 
SPLK #0800h.PMST 
Need this to work with real system, 
.else 

SPLK #0810h.PMST 



.endi ' 



SPLK 
SPLK 
SPLK 
SPLK 
SPLK 
SPLK 



ZAP 

LOP 

SACL 

LDP 

SACL 



#00h.CWSR 

#O0h.PDWSR 

#0FF09h.IOWSR 

#399. PRO 

#20h.TCR 

#010Ch.IMR 



#_Count_20_LSW 
_Count 20 LSW 

Count 20 MSW 



: Allow nornal Overflow in Acc 
:Load the Data Pointer to OOh 

simulator only. 

:IPTR = 0800h. clear the rest 



:Put SARAM into program memory 
:and set IPTR = 0800h 

Wait states are small and short 
Set 0 wait states for ext mem 
0.1. & 2 wait states at 40MHz 
20uS period timer. (50ns*(400-D) 
Reload and Enable the timer 
Disable all interupts except the 
timer, tach (Intr 3) and 
Command Interupt (Intr 4) 
Zero the accumulator 
Point to the memory location 
Zero the 20us count registar: 
Point to the memory location 
Zero the 20us count registar: 
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LDP. #_TachUpLimit : Point to the memory location 
SACL _TachUpLimit ;Zero the Tach Pulse check limit 
LDP #_TachLowLimit ;Point to the memory location 
SACL _TachLowLimit ;Zero the Tach Pulse check limit 
LDP #_Stat_Buffer : Point to the memory location 
SACL _Stat_Buffer ;Zero the Status Buffer; 
LDP #_Cmd_Bits ; Point to the memory location 
SACL _Cmd_Bits ;Zero the Command Bits registar: 
Reset should have cleared the Control Port. Now Clear the image- 
LDP #_Ctrl_Image ; Point to the memory location 
SACL _Ctrl_Image :Zero Control Port memory image 

Show that the Velocity Table has not been initialized 

LDP #_Vel_Table : Initialize Vel Table to -1 

SPLK #-l._Vel_Table ;Say the table is not initialized 

Show that the Inverse Time Table has not been initialized 

LDP #_InverseTime ; Initialize Inverse Time to -1 

SPLK #-1 ._InverseTime :Say the table is not initialized 

Initailize the Servo Loop Compensation Values 

LDP #Focus_Nl : Point to the memory location 

SPLK #Foc_Nl .Focus_Nl ;Store the initial value 

SPLK #Foc_N2.Focus_N2 :Store the initial value 

SPLK #Foc_N3. Focus JI3 ; Store the initial value 

SPLK #Foc_D2.Focus_D2 ;Store the initial value 

SPLK #Foc_D3.Focus_03 ;Store the initial value 

SPLK #Foc_G.Focus_G ; Store the initial value 

SPLK #Fin_Nl.Fine_Nl ; Store the initial value 

SPLK #Fin_N2.Fine_N2 ;Store the initial value 

SPLK #Fin_N3.Fine_N3 ; Store the initial value 

SPLK #Fin_D2,Fine_D2 ;Store the initial value 

SPLK #Fin_D3.Fine_D3 :Store the initial value 

SPLK #Fin_G.Fine_G ;Store the initial value 

SPLK #Cr_Nl.Crs_Nl ;Store the initial value 

SPLK #Cr_N2.Crs_N2 ; Store the initial value 

SPLK #Cr_N3.Crs_N3 :Store the initial value 

SPLK #Cr_D2 . Crs_D2 ; Store the initial value 

SPLK . #Cr_D3 . Crs_D3 ; Store the initial value 

SPLK #Cr G.Crs G ;Store the initial value 
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SPLK 


#Pn_G.Pin_G 


; Store the initial 


value 


SPLK 


#08000h.Sign_Bit 


:Store the initial 


value 


SPLK 


#0._FineDacZero 


;Store the initial 


value 


SPLK 


#0._CrsDacZero 


;Store the initial 


value 


SPLK 


#0._Foc_Err_Cnt 


:Store the initial 


value 


SPLK 


#07FFFH._Focus_Limit 


:Store the initial 


value 


SPLK 


#0._Fine_Err_Cnt 


;Store the initial 


value 


SPLK 


#07FFFH._Fine_Limit 


:Store the initial 


value 


CLRC 


INTM 


; Enable interupts 




RET 




; Return to the calling program 



